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A REAL-TIME DIGITAL COMPUTER PROGRAM FOR THE SIMULATION 


OF AUTOMATIC SPACECRAFT REENTRIES 


Jack T. Kaylor, Lawrence F. Rowell, 
and Richard W. Powell 
Langley Research Center 


SUMMARY 

The automatic reentry flight dynamics simulator (ARFDS), a nonlinear, six- 
degree-of-freedom simulation, digital computer program, has been developed at 
the NASA Langley Research Center (LaRC). The program includes a rotating, 
oblate Earth model for accurate navigation calculations and contains adjustable 
gains on the aerodynamic stability and control parameters. This program uses 
the Langley real-time simulation system (RTSS) available at LaRC and is designed 
to examine entries of vehicles which have constant mass properties (no main 
engine thrust), whose attitudes are controlled by both aerodynamic surfaces and 
reaction control thrusters, and which have automatic guidance and control sys- 
tems (no pilot in the loop). The program has been used to study the space shut- 
tle orbiter entry. 

This report includes descriptions of the equations of motion used, the con- 
trol and guidance schemes that were implemented, the program flow and operation, 
and the RTSS hardware involved. 


INTRODUCTION 

The automatic reentry flight dynamics simulator (ARFDS), developed by the 
NASA Langley Research Center (LaRC), is a nonlinear, six-degree-of-freedom simu- 
lation of a vehicle which has constant mass properties (no main engine thrust) 
and whose attitudes are controlled by both aerodynamic surfaces and reaction 
control system thrusters. A rotating, oblate Earth was modeled to obtain more 
accurate gravitational calculations for long-duration navigation studies. The 
ARFDS is being used to evaluate the automatic entry guidance and control systems 
of the space shuttle orbiter from 121.9 km (400 000 ft) down to the initiation 
of the terminal area phase which begins at 21.3 km (70 000 ft). Of primary 
interest are studies of the effects that off-nominal aerodynamics have on the 
performance of the guidance and control system. 

To facilitate a variety of studies, the program contains adjustable gains 
on the aerodynamic stability and control parameters and allows flight initial- 
ization at various points of the entry. To simulate the manner in which the 
automatic systems are used by the shuttle onboard computers, the sampling inter- 
vals for the guidance system and the control system can be chosen independently. 

The ARFDS does not allow for a pilot in the loop since it is designed to 
simulate automatic flight systems, but a derivative of the ARFDS, the orbiter 



flight dynamics simulator (OFDS), has been designed for use at LaRC with a sim- 
ulator cockpit and pilot. Only the ARFDS will be discussed in this report. 

The objectives of this report are to describe the simulation equations and 
special features in the ARFDS and to discuss briefly the Langley real-time simu- 
lation system (RTSS) facility and program operating procedures. 

The entry guidance system is described in appendix A. Appendix B describes 
the entry digital autopilot. The equations of motion are presented in appen- 
dix C. A convolution integration technique developed by Lawrence E. Barker and 
Lawrence F. Rowell of Langley Research Center is presented in appendix D. The 
ARFDS program listing is given in appendix E. 


SYMBOLS 


Values are given in both SI and U.S. Customary Units. The measurements 
were made in U.S. Customary Units. Symbols used only in the appendixes are 
defined therein. 

h altitude, m (ft) 

M Mach number 

p,q,r inertial roll, pitch, and yaw rates about body axes, rad/sec 

RCS reaction control system 

Vr Earth relative velocity, m/sec (ft/sec) 

Vx> Vy,Vz velocities along inertial axes, m/sec (ft/sec) 
x,y,z components of position along inertial axes, m (ft) 
a angle of attack, deg 

a c commanded angle of attack from guidance system, deg 

3 angle of sideslip, deg 

Y flight-path angle, deg 

6gp body flap deflection, deg 

<$ e total elevon deflection, deg 

S el elevon deflection, left panel, deg 

6 er elevon deflection, right panel, deg 

Ssb speed-brake deflection, deg 
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© c longitude, deg 

X geocentric latitude, deg 

<f> , Q ^ roll, pitch, and yaw angle about body axes, deg 

<t> c commanded bank angle from guidance system, deg 

4> e heading angle, deg 


PROBLEM DESCRIPTION 

The ARFDS was developed to examine the entry of the space shuttle orbiter 
from the atmospheric interface at 121.9 km (400 000 ft) with a velocity of 
8118.04 m/sec (26 634 fps) to the beginning of the terminal area phase at 21.3 km 
(70 000 ft) with a velocity of 454.15 m/sec (1490 fps). Below 21.3 km the shut- 
tle switches to different guidance and control systems, and these were not mod- 
eled. The physical characteristics of the space shuttle orbiter used in this 
program are described in table I. The aerodynamic data were obtained from the 


TABLE I.- PHYSICAL CHARACTERISTICS OF SPACE SHUTTLE ORBITER 


Hass properties: 

Mass, kg (lb) . . . . . 
Moments of inertia: 

Ixx i kg-m 2 (slug -ft 2 ) 
IyY> kg-m 2 (slug- ft 2 ) 
I ZZ» kg-m 2 (slug-ft 2 ) 
IXz> kg-m 2 (slug-ft 2 ) 
I XY = I YZ 

Wing: 

Reference area, m 2 (ft 2 ) 
Chord, m (ft) . . . ’. . 
Span , m ( f t ) 

El e von: 

Reference area, m 2 (ft 2 ) 
Chord, m (ft) ..... 

Rudder: 

Reference area, m 2 (ft 2 ) 
Chord, m (ft) . . . . . 



83 

001 

082 

986) 

1 

029 

066 

(759 

000) 

7 

816 

290 

(5 765 

000) 

8 

015 

596 

(5 912 

00D) 


177 

612 

(131 

000) 


0 


249.91 

(2690.0) 

12.06 

(39.57) 

23.79 

(78.06) 


19.51 

(210.0) 

2.30 

(7.56) 


9-30 

(100.15) 

1.86 

(6.1) 


Body flap: 

Reference area, m 2 (ft 2 ) ................. 12.54 (1.35.0) 

Chord, m (ft) .................. 2.06 (6.75) 


June 1974 space shuttle orbiter aerodynamic data base. Throughout the entry, 
the orbiter is directed by onboard computers which process, in the automatic 
mode, both the guidance system (appendix A) and the control system (appen- 
dix B) . Further information on the space shuttle systems and mission is given 
in reference 1 . 


3 



The simulation equations of motion described in appendix C include the grav- 
itational model, a rotating oblate Earth model, provisions for a wind model, and 
the viscous effects on the aeodynamic parameters. The aerodynamic interference 
with the reaction control system (RCS) thrusters is described in appendix B. 

The atmospheric model used in this program was the 1962 standard atmosphere. 

The integration of the linear differential equations encountered in the 
control system is performed by a one-pass, semianalytic scheme known as the con- 
volution method, and the difference equations resulting from this approach are 
discussed in appendix D. The function-look-up and interpolation algorithms were 
designed for simulations using the RTSS to reduce computer memory and execution 
time and are described in appendix B of reference 2. 


PROGRAM DESCRIPTION 

The ARFDS program was written to be operated from the Langley real-time 
simulation system (RTSS) facility, and, thus, required the inclusion of related 
supervisory software. The simulation presented in this paper was performed with 
the ICOPS operating system on CDC 6600 computers. The following discussion will 
briefly describe both the software and hardware components of the RTSS. In the 
fall of 1976 the Langley Research Center digital complex was upgraded with the 
acquisition of CDC CYBER 175 computers, a new operating system NOS (network 
operating system), and an expansion in the number of digital-to-analog convert- 
ers (DAC's). The simulation has been updated to operate under the NOS. 


RTSS Hardware 

The RTSS links a Control Data Corporation (CDC) 6600 computer to a simula- 
tion control station through the use of two peripheral processors. The control 
station, shown in figure 1, is used to direct the digital simulation program 
being processed on the CDC 6600 computer and to monitor the data being recorded 
on the various devices. 

The devices shown from the right to left in figure 1 are an on-line type- 
writer for message printout, the control console with digital decimal display, 
an X-Y plotter, a strip chart time-history recorder, and a cathode-ray tube for 
both real-time plotting and text editing. Not shown is a high-speed printer for 
data recording. 

The RTSS can be tied to any of several remote sites (fig. 2) where a pilot 
is brought into the loop through the use of simulation hardware such as cock- 
pits, scene generators, and motion bases. Three elements, the computer, the 
control station, and the remote sites, must be capable of exchanging signals. 

The analog signals from either the remote sites or the control station that are 
to be used by the computer must be converted to digital bit patterns . Likewise , 
the digital values sent from the computer to either the remote sites or the con- 
trol station must be converted to analog signals. Therefore, analog-to-digital 
conversion (ADC) and digital-to-analog conversion (DAC) must be performed when- 
ever computer input and output (I/O) are requested. The conversions of both the 
continuous and discrete analog signals to computer words are performed by the 
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Figure 1 . - Typical program control station . 














analog-to-digital and discrete-input system (ADDIS), whereas the conversions 
from computer words to analog signals are performed by the digital-to-analog 
and discrete-output system (DADOS). 

The I/O is performed when called for periodically by the real-time clock. 
This transfer of information must be performed at a rate high enough to insure 
that the signals used to drive scene generators, cockpit Instruments, and other 
simulation hardware appear to be continuous. Experience has shown in most cases 
that if I/O is performed at a rate of 16 times a second or greater, no discon- 
tinuities will be observed by a pilot performing simulation flight tasks. Pro- 
grams, then, will normally use an integration step size of between 1/16 and 1/32 
of a second, and the new information produced with each iteration can be synchro- 
nized with real time by using the clock to call for I/O at the appropriate time 
after the completion of each integration step. 


RTSS Software 

The simulation program contains two arrays with the FORTRAN names ADC and 
DAC. The digital values computed by the program are stored in the DAC array to 
await conversion by DADOS, whereas analog signals, such as controller deflec- 
tions from remote sites, have their values converted by ADDIS and placed in the 
ADC array for use within the program. These two arrays are used by the super- 
visory software as the storage locations for values transferred between comput- 
ers and hardware. In a similar manner, logical program variables that must be 
sent to hardware (logical discretes out) for purposes of activating lights or 
switches are stored in the FORTRAN array designated LDISO. Hardware items, such 
as push buttons or switches, needed to select program options (logical discretes 
in) have their signals converted to digital true-or- false bit patterns and stored 
in the array LDISI. 


Control Console 

Figure 3 shows a closeup of the control console. There are three blocks 
of switches (discretes into the program, LDISI) with 16 push buttons each and a 
large group of numbered white and red lights (discretes out of the program, 
LDISO). Switches in the block on the far left are used as logical variables to 
select options programed into the simulation. The numbered lights are turned on 
by program logical variables and are used to mark the occurrence of selected 
events. 

The group of switches on the right is used to address locations in the com- 
puter memory and to either change or display their values on the digital deci- 
mal display unit located immediately below the switches. The center group of 
switches is used to control the mode of program operation. The mode controls 
were designed to be similar to the analog computer, that is, initial condition 
or reset, hold, and operate. This group also contains special purpose buttons 
to print or erase data, to read data, and to take the program out of real-time 
operation. The 10 potentiometers (brought into the program through the ADC's) 
can be used as additional inputs to the program. 
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Figure 3-- Closeup of control panel on program control console. 






Program Flow 


The FORTRAN program code must be divided functionally to utilize the mode 
switches just described. Figure 4 is a simplified flow diagram indicating the 
functions performed by each of the three principal modes (reset, hold, and oper- 
ate) that can be selected at the control console. The following discussion of 
figure 4 defines each of the major calls to RTSS software shown in the figure, 
as well as the purpose of each mode. 


The first block containing "constants and initialization" represents any 
code that must be performed only once when the program is first submitted to the 
computer. The call to READY begins clock synchronization of both the iterative 
computations and the input and output through ADDIS and DADOS. From this point, 
all calculations must be performed fast enough to complete one integration step 
before the next clock pulse calls for I/O. 

Selecting the RESET button at the control console will place the flow in a 
loop beginning with the block containing "initial conditions" and extending to 
the call to RTMODE. RTMODE checks the switch setting of the control console and 
directs the flow according to the mode switch that is depressed. In RESET, the 
value of INT is zero. A HOLD mode selected by pressing the HOLD button is avail- 
able which will loop from the block of "hold equations" to the call to RTMODE. 

The HOLD mode, although not used in this simulation, normally consists of any 
special equations, such as trim calculation, that are to be performed before the 
simulation proceeds with the integration process. 

The OPERATE mode extends from the block containing "ADC's and LDISI's" to 
the call to RECYCLE. This mode performs the integration as well as data stor- 
age. The call to DSPLAY is made once per iteration during all three modes to 
update the digital decimal display on the control console. The subroutine 
RECORD is called only once per iteration in the operate mode to save for print- 
ing the current values of any variables previously specified by calls made to 
system subroutines in the initialization section. 

The subroutine IGRATE1 is a standard subroutine which performs the numeri- 
cal integration of all nonlinear differential equations by one of the following 
methods: 

(1) Runge-Kutta, second order 

(2) Runge-Kutta, fourth order 

(3) Adams-Moulton, second order 

(4) Adams-Moulton, fourth order 

For these multipass schemes, the flag INT is needed to control the looping 
and to insure that data are recorded and I/O performed only when an integration 
step is completed (indicated by INT = 1). Predictor-corrector methods (3) 
and (4) can be reduced to single-pass, predictor-only methods when appropriate. 
ARFDS uses the second order Runge-Kutta integration scheme for the numerical 
integration of the equations of motion. 
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The calls to C0NV01 and MODLAG represent special integration routines which 
have been designed for the solution of linear differential equations and are 
used for the solution of the linear control system equations of ARFDS, Both 
of these routines use a convolution integration technique (appendix D) which 
requires one pass and can be used with the multipass methods in IGRATE1. The 
MOBLAG routine includes provisions for rate and position limiting, 

RECYCLE is called when one iteration (all passes of an integration step) of 
the problem is completed. At this point the program will cease calculations 
until a clock pulse signals for I/O and the latest inputs are available for the 
next iteration in OPERATE. 

There are other calls to RTSS software used primarily in the initialization 
of the program, but they will not be discussed here. Figure 5 is a more detailed 
diagram of the ARFDS program indicating where the primary components of the sim- 
ulation are computed. Copies of the main program, its variable cross-reference 
map, and source listings of the major mathematical subroutines are supplied in 
appendix E. Most of the routines are in FORTRAN, but the COMPASS language rou- 
tine was also included for completeness. Figure 6 is a block diagram that 
describes the flow of variables through the guidance system, control system, 
and equations of motion for the ARFDS program. 
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Figure 5.- Block diagram of simulation program functions. 
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Figure 5.- Continued. 
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Figure 5.- Concluded. 
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Entry Digital Autopilot 



Figure 6.- Block diagram showing variable flow between guidance and control 

systems and equations of motion. 
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PROGRAM OPERATION 


When a simulation program is first submitted to the computer for processing, 
the user should have the RESET switch selected at the control console. Thus, 
when the program begins execution, it will perform all initialization tasks and 
then loop in the RESET mode until some change is made at the console. Some of 
the changes that might be made include altering the value of a program parameter, 
selecting program options using the logical switches, reading data, or going to 
the hold or operate modes. 

The ARFDS requires initialization of the variables p, q, r, a, 3, y, 

<j>, V R> ^e> ®c> anc * h. These variables are used in transformations to 

get the initial conditions for the state variables of integration: p, q, r, 

9, Vx, Vy, Vz> x, y, and z. The velocities are integrated in the 

inertial frame, Body-axis system velocities are obtained by transformation from 
the inertial axis. 

For the purpose of changing values, any computer location in the program 
can be addressed from the console. However, the variables most frequently 
altered have been set up in three FORTRAN arrays called TABLE for floating point 
numbers, INTEG for integer numbers, and LOGIC for logical variables. These 
arrays are the most easily accessed from the console. In the ARFDS, TABLE con- 
tains, by a FORTRAN EQUIVALENCE, the following: the orbiter physical properties, 

the center-of-gravity offsets, the data recording rate, initial conditions, the 
variables reserved for future use, the initial control deflections, the constant 
wind components, the aerodynamic-stability and control parameter gains, and the 
guidance system sampling interval. The variable gains on each of the aerodynamic 
stability and control parameters are to be used in sensitivity studies. 

The INTEG array contains, by a FORTRAN EQUIVALENCE, integers such as run 
number, the number of integration steps per second, the integration scheme 
selected, and the initial guidance phase. The first two variables in the LOGIC 
array, when set true, bypass the viscous interaction calculations and replace 
the oblate Earth model with a spherical Earth model. 

The 16 switches in the block used for mode control are the logical discretes 
LDISI(17) to LDISI(32) which are numbered from left to right by rows starting 
with the top row. The function of each of these switches has previously been 
established and is incorporated in supervisory software. 


Function Switches 

The 16 function switches, logical discretes LDISI(33) to LDISI(48), have 
been assigned uses in ARFDS as follows: 

Switch Function 


1 


False - Calculate guidance equations each pass of the 
integration step. 
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Switch 


Function 


True - Calculate guidance equations only at intervals of 
GUIDDT seconds. 

2 False - Variables to be integrated by IGRATE1 will use the 

normal scheme as selected by the integer ISCHEME. 

True - If the scheme is a predictor-corrector method, use 
only the predictor pass. 

3 False - Perform calculations in synchronization with the 

real-time clock. 

True - Process one iteration each time function switch 8 is 
pressed. Function switch 12 will cause the value in 
the digital decimal display to be typed out. 

5 False - Evaluate aerodynamic functions for each pass of a 

multipass integration step. 

True - Evaluate aerodynamic functions during the first pass 
only of a multipass method. 

8, 12 Used in conjunction with function switch 3. 

15 False - No effect. 

True - Type out the address and value of the variable in 
the digital decimal display. 

16 False - Variables brought into the digital decimal display 

must be addressed by their specific locations in 
computer memory. 

True - Variables in the arrays TABLE, INTEG, LOGIC, ADC, 
DAC, LDISI, and LDISO are brought into the digital 
decimal display in the addresses from 1 to 900. 


Not used. 


4, 6, 7, 9j 
10, 11, 13, > 
14 J 


The function switches are the inputs to the simulation program that can be 
made from the control console. This program does not use any of the 10 potenti- 
ometers on the console or any remote hardware site. 

The principal outputs from the program to the control station are 16 time- 
history recorder channels which are driven by DAC(1) to DAC(16). In addition, 
the first five white lights, LDIS0(6l) to LDISO(65), are used to indicate the 
current guidance phase. The first three red lights, LDISO(III) to LDIS0(113), 
are used to indicate the intersection with the terminal area phase of the 
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reentry. The additional white lights used, LDIS0(8l) to LDISO(88), indicate 
RCS thruster firings, and the discrete event markers, LDIS0(103) to LDIS0(108), 
located between time-history channels record the same information. The remain- 
ing event markers, LDIS0(109) and LDISO(46) to LDISO(48), record the guidance 
(appendix A) phase changes on the time-history recorders. 


Labeled COMMON 

The labeled COMMON arrays used to communicate variables between the main 

applications program and the subroutines are as follows: 

REALTIM Contains the arrays ACD, DAC, LDISI, and LDISO and the addresses 

which control the looping for the various modes of operation. 

INTCOMM Carries information between the main program and the integration 

subroutine, IGRATE1 , which is used to solve the nonlinear differ- 
ential equations. The variables are current time, step size, 
multipass control flag, number of equations (NEQ) to be inte- 
grated, integration scheme selected, and a 2 x NEQ array contain- 
ing the integrals and derivatives. 

INTINTR Contains a 5 x NEQ buffer used by IGRATE1 . 

CC0NA1 Carries information between the main program and the integration 

subroutine, C0NV01, which is used to solve the linear differen- 
tial equations of the control system. The variables are step 
size, number of equations (NEQ1) to be integrated, and a 
10 x NEQ1 array containing the inputs into and the solution 
states from the transfer function. 

TABLES Carries the variables expressed as equivalents to TABLE and 

INTEG into the subroutines that need these values. 

DRIVER Carries the independent variables of the aerodynamic functions 

into subroutine DATAFUN. These variables are a, M, Sgg, 5 e , 

^BF > ^ei > anc ^ ^er • 

FUNCNAM Returns to the main program the results of the aerodynamic func- 

tion table look up performed by the subroutine DATAFUN. 


SIMULATION VALIDATION 

Because of the discontinuous derivatives produced in the equations of 
motion by the RCS, a Runge-Kutta integration was used in preference to a 
predictor-corrector method. The transfer functions of the control system were 
solved by difference equations resulting from the convolution method of appen- 
dix D. At the time ARFDS was developed, the specific integration method to be 
used by the onboard control system software was not known. In later versions of 
ARFDS, the difference equations used for the control system will reflect the 
actual techniques used onboard the shuttle, 
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Results from the completed real-time program were compared with results 
from an independent dynamic check. Results were compared for both a second- 
and a fourth-order Runge-Kutta scheme with various step sizes. In each case, 
complete entries were flown to insure that all guidance and control phases were 
exercised. The integration step size was chosen to be 1/25 of a second to match 
the actual minimum pulse width of the RCS thrusters. With this step size, the 
second-order integration scheme provided accurate results for the frequencies of 
the system studied. 


PROGRAM APPLICATIONS 

The ARFDS has been used in the evaluation of the space shuttle orbiter 
entry guidance and control systems. From these evaluations, suggestions have 
been made for modifications to the guidance and control systems which maintain 
vehicle performance while reducing the amount of RCS fuel required for the 
entry (ref. 3). For one study, the guidance system was replaced with one that 
issued step commands at selected times in order to evaluate the control system 
responses. In addition, the orbiter sensitivity to off-nominal aerodynamics 
has been studied, and modifications to the control system to make the orbiter 
more tolerant of the off-nominal aerodynamics have been identified. 


CONCLUDING REMARKS 


A nonlinear, six-degree-of-freedom simulation known as the automatic reen- 
try flight dynamics simulator (ARFDS) has been developed at the Langley Research 
Center. The ARFDS model is for a vehicle which has constant mass properties (no 
main engine thrust) and whose attitudes are controlled by both aerodynamic sur- 
faces and reaction control system thrusters. 

The simulation was used in the evaluation of the space shuttle orbiter 
entry guidance and control systems. To date, it has been used to suggest modifi- 
cations to the guidance and control systems that maintained vehicle performance 
while reducing the amount of required reaction control system fuel. Also, the 
sensitivity of the control system to off-nominal aerodynamics has been examined. 


Langley Research Center 

National Aeronautics and Space Administration 
Hampton, VA 23665 
February 10, 1977 
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APPENDIX A 


ENTRY GUIDANCE SYSTEM 

The baseline guidance scheme controls the entry by roll modulation while 
the space shuttle orbiter is flying a preselected angle-of -attack profile. The 
downrange is controlled by the magnitude of the roll angle, and the crossrange 
is controlled by. multiple bank reversals. The guidance system outputs to the 
control system are commanded roll angle and commanded angle of attack. 

The entry guidance system was developed by the NASA Johnson Space Center 
to follow a previously determined entry profile. This profile is achieved by 
dividing the entry into five major phases as illustrated in figure A1: 

( 1 ) Constant-attitude phase 

(2) Constant-heat-rate phase 


(3) Equilibrium glide phase 

(4) Constant-drag phase 

(5) Transition phase 


The space shuttle orbiter is commanded to fly a constant-attitude trajec- 
tory until a specified total acceleration is attained. At this point, a con- 
stant stagnation heat-rate trajectory is flown through pullout to a relative 
velocity of 6248.4 m/sec (20 500 fps) or until the reference drag level becomes 
larger than that required to reach the target. If the latter condition is 
reached, the guidance scheme jumps to the constant-drag phase. If this condi- 
tion is not met, an equilibrium glide profile is flown either until the refer- 
ence drag level intersects the constant-drag profile required to reach the tar- 
get and then jumps to the constant-drag phase or until the velocity drops off to 
2743.2 m/sec (9000 fps). Whenever the velocity drops to 2743.2 m/sec (9000 fps), 
the transition phase is entered. During the transition phase, the commanded 
angle of attack is decreased to the value required at the terminal-area phase 
intersection, which occurs at a velocity of 457.2 m/sec (1500 fps) and at an 
altitude of approximately 21.3 km (70 000 ft). 


Table AI shows the input constants that were used, and figure A2 shows the 
block diagram of the guidance laws. 


SYMBOLS 

A,B parameters used in FORTRAN SIGN function 

AK dD/dV for constant-heat-rate phase, used to define C23, sec - ^ 

ALDREF (L/D) re f, used in controller 
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ALFM 

ALMN1 

ALMN2 

ALPCMD 

AMAXI 

ARC 

ARG 

ATK 

BA 

BAD 

BA1 

BA2 

CAGI 

CIGAR 

CO SB ADD 

CTH 

C4 

C5 

C11 

C16 

C17 

C21 

C22 


reference equilibrium glide drag, m/sec 2 (ft/sec 2 ) 
minimum roll command outside of lateral deadband YB, rad 
minimum roll command inside of lateral deadband YB, rad 
angle-of-attack command, a c > deg 
maximum value function 

distance from intersection with alinement circle to target, m (ft) 
(L/D) V /(L/D) used in roll-command equations, rad 
radius of Earth, m (ft) 

equilibrium glide roll angle used in iteration loop, rad 

final equilibrium glide roll angle, deg 

first iteration equilibrium glide roll angle, deg 

second iteration equilibrium glide roll angle, deg 

temporary calculation used in transition phase to calculate ALDREF 
and RDTREF, sec 2 /m 2 (sec 2 /ft 2 ) 

transformation matrix from Earth-centered inertial (ECI) axes to 
geocentric axes 

temporary calculation in equilibrium glide ranging phase used to 
calculate DREFP 

great circle range from orbiter to target, rad 

coefficient used to calculate RDTREF, m/sec (ft/sec) 

coefficient used to calculate RDTREF, m/sec (ft/sec) 

parameter used to calculate RER1 and RDTREF, m -1 (ft" 1 ) 

coefficient used to calculate LODI, sec 2 /m (sec 2 /ft) 

coefficient used to calculate LODI, sec/m (sec/ft) 

parameter used to calculate DREFP, RDTREF, SQ, and TT11, 
m/sec 2 (ft/sec 2 ) 

parameter used to calculate DREFP, El, E2, RDTREF, SQ, TT11, 
and TT22 , sec -1 
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C23 

D 

DBAR 

DBB 

DELAZ 

DF 

DLIM 

DRAG 

DREFP 

DT 

DTH 

DTR 

DVHEAD 

D23 

EEF 

EEF4 

E1,E2 

GAMMA 

GCLAT 

GCLATT 

GS 

GSTART 

HA 

HADOT 

HDSER 


parameter used to calculate C22, DREFP, El, E2, SQ, TT11, 
and TT22, nr 1 (ft" 1 ) 

total drag force, N (lb) 

distance from runway to alinement circle, m (ft) 
increment in roll angle in equilibrium glide phase, deg 
azimuth error, rad 

final drag level in transition phase, m/sec 2 (ft/sec 2 ). 

control system limit drag level in transition phase, m/sec 2 (ft/sec 2 ) 

current drag acceleration level, m/sec 2 (ft/sec 2 ) 

drag reference used in controller, m/sec 2 (ft/sec 2 ) 

planar range to target, m (ft) 

angle between alinement circle center and tangency point, rad 
= 11/180 , rad /deg 

azimuth between runway and heading to tangency point of alinement 
circle, rad 

parameter used to calculate AK, m/sec 2 (ft/sec 2 ) 
current energy level, m 2 /sec 2 (ft 2 /sec 2 ) 

reference energy level used in transition phase, m 2 /sec 2 (ft 2 /sec 2 ) 

parameters used to calculate TT22 

flight-path angle , rad 

orbiter geocentric latitude, rad 

target geocentric latitude, rad 

acceleration of gravity at sea level, m/sec 2 (ft/sec 2 ) 
acceleration required to initiate constant-heat-rate phase, g units 
current altitude, m (ft) 

= d(HA)/dt, m/sec (ft/sec) 

parameter in oblate Earth correction term to RDTREF, m3/sec (ft^/sec) 
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HS 

IDFG2 

IDFG3 

IFT 

ISLECT 

ISTART 

ISTP 

ISTRT 

ITR 

L/D 

(L/D) re f 

(L/D)y 

LMN 

LN 

LODI 

PSIE 

PSIET 

RAZ 

RCG 

RDC 

RDTOLD 

RDTOL2 

RDTREF 

REC 

REC1 

REH 


altitude scale height, m (ft) 
switching flag in constant-drag phase 
switching flag in transition phase 
initialization flag in equilibrium glide phase 
phase selector 
initialization flag 

iteration flag in equilibrium glide phase 

flag indicating acceleration level equal to GSTART has been reached 

iteration flag in transition phase 

lift-drag ratio 

reference lift-drag ratio 

lift-drag ratio in vertical plane 

minimum value of LODI 

natural logarithm function 

desired (L/D) v 

current heading of orbiter, rad 
current heading to target, rad 
runway azimuth, rad 

predicted range in constant-drag phase, m (ft) 
parameter used in RDTREF calculation 

final RDTREF in equilibrium glide phase, m/sec (ft/sec) 
final RDTREF in constant-drag phase, m/sec (ft/sec) 
altitude rate reference, m/sec (ft/sec) 
vector defining runway coordinate system 
= (REC)-I 

distance from center of Earth to vehicle, m (ft) 
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REQ predicted equilibrium glide phase range, m (ft) 

RER1 parameter in range prediction for transition phase, m (ft) 

RFF predicted range in constant-heat-rate phase, m (ft) 

RG- vector from orbiter to runway center, m (ft) 

RGP vector from orbiter to alinement circle center, m (ft) 

RK2R0L roll direction (+ right, - left) 

RLON longitude of orbiter, rad 

RLONT target longitude, rad 

ROLLC roll-angle command, <j) c , rad 

RPT desired range in transition phase, m (ft) 

RPT1 range bias below velocity of 456.2 m/sec (1500 fps), m (ft) 

RTE radius of Earth at runway, m (ft) 

RTURN radius of alinement circle, m (ft) 

R11 first iteration of range prediction in equilibrium glide and 

transition phases, m (ft) 

R12 second iteration of range prediction in equilibrium glide and 

transition phases, m (ft) 

SIGN(A,B) function which gives to value of A the algebraic sign of 
variable B 

parameter used in constant-heat-rate range prediction, sec -2 

parameter used in constant-heat-rate range prediction, sec - ^ 

vector from alinement circle tangency point to vehicle, m (ft) 

vector TA in geocentric coordinates, m (ft) 

target vector from alinement circle center to runway, m (ft) 

parameter used in DREFP calculation in equilibrium glide phase, 
m/sec 2 (ft/sec 2 ) 

temporary calculation in equilibrium glide phase, m (ft) 
great circle range from orbiter to target, m (ft) 


SQ 

SQQ 

TA 

TAP 

TARE 

TDREF 

TEMP 

TRANGE 
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T1 

T2 

TT 1 1 , TT22 
U 

UTARE 

UXYZE 

V 

VBB 

VCG 

VINERT 

VOLD 

V0LD2 

V Q 

VSAT 
VI OLD 
V20LD 
XLFAC 
XLOD 

XYZE 

YB 


parameter used in calculation of ALDREF, m/sec^ (ft/sec^) 

constant drag level required to reach target, m/sec^ (ft/sec^) 

parameters used in range prediction in constant-heat-rate phase, 
m (ft) 

= | DVHEAD| , rad 
TARE unit vector 
RG unit vector 

Earth relative velocity, m/sec (ft/sec) 

intersection velocity between constant-heat-rate phase and equilibrium 
glide phase, m/sec (ft/sec) 

predicted intersection velocity between constant-drag phase and equi- 
librium glide phase, m/sec (ft/sec) 

inertial velocity, m/sec (ft/sec) 

final velocity in equilibrium glide phase, m/sec (ft/sec) 

final velocity in constant-drag phase, m/sec (ft/sec) 

predicted final velocity for constant-drag phase, m/sec (ft/sec) 

reference circular orbit velocity, m/sec (ft/sec) 

value of VOLD- 152. 4, m/sec (ft/sec) 

value of V0LD2-152.4, m/sec (ft/sec) 

total acceleration, m/sec^ (ft/sec^) 

L/D of vehicle with undeflected control surfaces including viscous 
effects 

geocentric position vector, m (ft) 

lateral deadband (amount of overshoot that guidance system will allow 
before commanding roll reversal), rad 
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TABLE AI.- ENTRY GUIDANCE INPUT CONSTANTS 


Parameter 

Value 

Unit 

ALFM 

7.62 (25) 

m/sec 2 (ft/sec 2 ) 

ALMN1 

0.7986355 

rad 

ALMN2 

0.9659258262 

rad 

ATK 

6 366 707.02 (2.08881464 x 10?) 

m (ft) 

DBAR 

14 360.4 (48 000) 

m (ft) 

DF 

5.819 (19.09) 

m/sec 2 (ft/sec 2 ) 

EEF4 

185 806.08 (2.0 x 10 6 ) 

m 2 /see 2 (ft 2 /sec 2 ) 

GCLATT 

34.55577617 

deg 

GS 

9.815 (32.2) 

m/sec 2 (ft/see 2 ) 

GST ART 

0.05 

g units 

RAZ 

-0.7679448709 

rad 

RLONT 

-120.5338 

deg 

RPT 

421 885.6 (1.3841391 x 10 6 ) 

m (ft) 

RPT1 

23 150 (75 951.4) 

m (ft) 

RTE 

637 329 8.953 (2.090977347 x 107) 

m (ft) 

RTURN 

4 632.96 (15 200) 

m (ft) 

VQ 

2 133.6 (7 000) 

m/sec (ft/sec) 

VSAT 

7 853.54 (25 766.2) 

m/sec (ft/see) 
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*ISLECT = 0 initially 

Figure A1 Entry guidance system flow diagram. 
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REC(1,1) 
REC (1,2) 
REC (1,3) 
REC(2,1) 
REC (2,2) 
REC(2,3) 
REC(3,1) 
REC (3,2) 
REC(3,3) 



- C0S ( RAZ ) *S I N (GCLATT ) *C0S ( RL0NT ) - S I N ( RAZ ) *S I N ( RL0NT ) 
-C0S ( RAZ ) *S I N ( GCLATT ) *S I N (RL0NT )+S I N ( RAZ ) *C0S ( RL0NT ) 
C0S ( RAZ ) *C0S (GCL ATT ) 

S I N ( RAZ ) *S I N ( GCLATT ) *C0S ( RL0NT ) - C0S ( RAZ ) *S I N ( RL0NT ) 

S I N ( RAZ ) *S I N (GCLATT ) *S I N ( RL0NT ) +C0S ( RAZ ) *C0S ( RL0NT ) 
-SIN (RAZ )*C0S (GCLATT) 

-C0S ( GCLATT )*C0S(RL0NT) 

- C0S ( GC L ATT ) *S I N ( RL0 NT ) 

-SIN(GCLATT) 



Figure A2.- Analytic drag control entry guidance system block diagram. 
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TARGETING 


[RG]= [REC] [XYZE] 

RG(3) = RG(3)+RTE 

RGP(l) = RG(1)+DBAR 

RGP (2 ) = RG(2)-SIGN(RTURN,RG(2)) 

RGP(3) = RG(3l 

DT = /AMAX1(0 ,RGP(1)2+RGP(2)2-RTURN 2 ) 

DTH = TAN-1(RTURN/DT) 

DVHEAD = TAN- 1 (-RGP(2)/(-RGP(l)-SIGN(DTH,RG(2))) 
U = | DVHEAD) 



Figure A2.- Continued. 
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Figure A2.- Continued. 
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Figure A2.- Continued 
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Figure A2.- Continued. 
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Figure A2.- Continued. 
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TDREF = 
C0SBADD 
DREFP = 
RDTREF = 
V0LD = V 
RDT0LD = 
ALDREF = 



GS*(V 2 /VSAT 2 - 1 ) 

= 1 . 4*C0S ( BAD*DTR) 

- TDREF/ C0SBADD 

-2 *HS*DREFP/V - 2 *HS*GS*V/ (C0SBADD*VSAT 2 ) + C4 + C5*V 
RDTREF 

-T] /DREFP + 2 *HS*GS/(C0SBADD*VSAT 2 ) + 2 *HS*DREFP/V 2 



Figure A2.- Continued. 
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Figure A2.- Continued. 
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Figure A2.- Continued. 
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Figure A2.- Continued. 
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Figure A2.- Concluded. 
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a y 

^he 

C h$ 

C h6 r 

C LN 

C ML 

C MN 

C NL 

c e 

G r 

DEMX 

DRMX 

Ep 

Er 

e y 

f(«e) 


Hm e 

Hm r 

K L 

k MD 

k mu 

k n 
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ENTRY DIGITAL AUTOPILOT 
Symbols 

side acceleration at center of gravity, m/sec 2 (ft/sec 2 ) 
elevon hinge-moment coefficient 
= 3 (rudder hinge moment )/3$ 

= 3 (rudder hinge moment )/36 p 
rolling-moment coefficient due to yaw RCS 
pitching-moment coefficient due to roll RCS 
pitching-moment coefficient due to yaw RCS 
yawing-moment coefficient due to roll RCS 
elevon reference chord, m (ft) 
rudder reference chord, m (ft) 
maximum elevon rate, deg/sec 
maximum rudder rate, deg/sec 
pitch RCS error signal 
roll RCS error signal 
yaw RCS error signal 

function of <$ 8 used to limit S a>c , deg 
acceleration due to gravity, m/sec 2 (ft/sec 2 ) 
elevon hinge moment, N-m (lbf-ft) 
rudder hinge moment, N-m (lbf-ft) 
rolling-moment RCS amplification factor 

pitching-moment RCS amplification factor due to down-firing jets 
pitching-moment RCS amplification factor due to up-firing jets 
yawing-moment RCS amplification factor 
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Kp aileron gain 

Kqj elevator gain 

rudder gain 

kRCS rolling moment due to RCS, N-m (lbf-ft) 

Lrj ideal rolling moment due to firing of one roll jet, N-m (lbf-ft) 

Mpj ideal pitching moment due to firing of one pitch jet, N-m (lbf-ft) 

MrcS pitching moment due to RCS, N-m (lbf-ft) 

NrCS yawing moment due to RCS, N-m (lbf-ft) 

Nyj ideal yawing moment due to firing of one yaw jet, N-m (lbf-ft) 

PJN number of negative pitch jets firing 

PJP number of positive pitch jets firing 

p roll rate, deg/sec 

q pitch rate, deg/sec 

q dynamic pressure, Pa (psf) 

RJN number of negative roll jets firing 

RJP number of positive roll jets firing 

r yaw rate, deg/sec 

r* a r - (l80g sin $ cos 0)/irVp, deg/sec 

S e elevon reference area, m 2 (ft 2 ) 

S r rudder reference area, m 2 (ft 2 ) 

s Laplace operator 

YJN number of negative yawing jets firing 

YJP number of positive yawing jets firing 

6 a aileron deflection, deg 

6 a>c commanded aileron deflection, deg 

6 a ,UD aileron deflection at up-down counter, deg 
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S e>c commanded elevon deflection, deg 

^ei,c commanded left elevon panel deflection, deg 

^e,im maximum change in elevon command that can be realized in one control 
cycle, deg 

6 er right elevon panel deflection, deg 

<5 e r,c commanded right elevon panel deflection, deg 

<5 e> t initial elevator setting, deg 

<5 r rudder deflection, deg 

6 r>c commanded rudder deflection, deg 

6 r , lm maximum change in rudder command that can be realized in one control 
cycle, deg 


Entry Digital Autopilot Filters and Controls 

The entry digital autopilot ( EDAP ) is designed to fly the space shuttle 
orbiter automatically from deorbit to the terminal area interface which occurs at 
an altitude of approximately 21.3 km (70 000 ft) with a velocity of 457.2 m/sec 
(1500 ft/sec). The EDAP directs both the reaction control system (RCS) and the 
aerodynamic control surfaces ( 6 e , 6 a , 6 r , 6 gp, and 633 ). Two types of signal 
limiting filters are used in this autopilot. The first type is illustrated in 
sketch (a): 



Sketch (a) 


This filter limits the value of the quantity A to be between x and y. The 
second type, called a "hysteresis filter," can appear in one of two ways (see 
sketch (b)): 


A r 

-b -a 



'f 

V A 

err . A 

-b -a 


err 


■u n 

A 

<> »> 

a b 

^ ii — ► 


a b 



( 1 ) ( 2 ) 


Sketch (b) 
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As A increases from zero, "err" remains zero until point "b" is reached. At 
this time, "err” becomes the value indicated (either a constant value if filter 
is type 1 or equal to A if filter is type 2) and continues as A increases. 
As A starts to decrease, it remains the value indicated until point "a" is 
reached, where "err" becomes zero again. A similar situation would exist for 
an A decreasing from zero. 


Aerodynamic Control 

The speed-brake 633 and body-flap 6 gp deflection schedules are shown 
in figure B1, where 633 is determined from a preset velocity schedule and 6 gp 
is dependent on the center-of-gravity location. Figures B2 to BIO are block 
diagrams of the various elements of the EDAP. 

The elevens are used for both elevator 6 e and aileron 6 a functions. 

The elevator-command block diagram is shown in figure B2. The aileron func- 
tions in one of two ways depending on the flight regime.. For a S 18 ° and 
M $ 5, the aileron is used for roll attitude <j> control (fig. B3(a)); when 
these conditions are not present, the ailerons are used for turn coordination 
(fig. B3(b) ) , 

If the orbiter has a lateral center-of-gravity offset, the number of pos- 
itive yaw and roll thruster firings will not equal the number of negative yaw 
and roll thruster firings because of the induced sideslip. By counting the 
number of positive and negative yaw and roll thruster firings, it is possible 
to establish the "steady-state" aileron deflection required to offset this 
induced sideslip. This is the role of the "up-down counter" shown in figure B4. 
The numbers in parentheses in the block diagrams are the expressed values in 
U.S. Customary Units. 

Figure B5 shows that the commanded left and right elevon deflections are 
functions of 6 e , 6 a c , and c- The rudder deflection S r (fig. B 6 ) is 
used for turn coordination when £he aileron is used for roll control. If the 
ailerons are being used for turn coordination, the rudder is inoperative. 


Reaction Control System 

The pitch reaction control system (RCS) (fig. B7) is operative for q less 
than 958 Pa (20 psf). In this regime it is used, along with the elevator con- 
trol system, for longitudinal control. 

The roll RCS (fig. B 8 ) is operative for q less than 479 Pa (10 psf) and 
is used, along with the aileron control system, for turn coordination. 

The yaw RCS (fig. B9(a)) aids the rudder control system in maintaining turn 
coordination. If the conditions are such that the ailerons are used for turn 
coordination, the yaw RCS (fig, B9(b)) is used for roll attitude <t> control. 

The RCS error signals command control jet firings, and the particular jets 
fired are a function of the sign and magnitude of the error signals. The sign 
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of the error signal determines vehicle motion direction; that is, a positive 
signal fires rockets that yield a positive (+) roll, pitch, or yaw motion, and 
negative signals command negative (-) motions. The number of jets fired is 
proportional to the magnitude of the error signals. (See figs. B7 to B9.) 


Aerodynamic Interference Equations 

The RCS model uses the following equations to account for aerodynamic 
interference: 


LRCS = L R j[(RJP - RJN)K L + (YJP - YJN)ClnJ 

M RCS = M pj [(PJP)K mu - (PJN)K md + (YJP + YJN)C MN + (RJP + RJN)C ML ] 

Nrcs = Nyj[(YJP - YJN)K N + (RJP - RJN)CnQ 
The values for the coefficients are shown in table BI. 


Integration Schemes 

To integrate the linear first-order differential equations in the control 
system, the convolution technique of appendix D is used. This is a one-pass 
scheme that has demonstrated a high degree of accuracy in other real-time simu- 
lations, including piloted simulations, (for example, see ref. 2.) The control 
actuators (fig. BIO) are integrated the same way, except that provisions are 
made for both position and rate limits. 
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TABLE BI.- INTERFERENCE RCS VALUES 
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Figure BIO.- Actuator block diagrams 
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EQUATIONS OF MOTION 

The mathematical model is that of a nonlinear six-degree-of-freedom rigid 
body with nonlinear aerodynamics. Forces and moments are calculated in the 
Vehicle body axis system. The Earth model is an oblate spheroid defined by an 
equatorial radius, a polar radius, rotational rate, and a gravitational model 
with second harmonics. Axis systems used in the mathematical model include body, 
inertial, relative geocentric, and inertial geocentric systems. The latitude and 
longitude rates are computed from relative geocentric velocities. Wind compo- 
nents can be programmatically varied or deleted. Figure Cl is a detailed block 
diagram showing state variable flow for the equations of motion and the indepen- 
dent variables for function generation. 


Symbols 


A 

a x , a y , a z 

b 

C' 

C AF 

C D 

C DT 

C DV 

C H 

C L 

C LT 

C LV 

C m 

c mV 

C n 

C Y 


longitudinal rate, rad/sec 

accelerations along body axes,, m/sec^ (ft/sec^) 
wing span, m (ft) 
temperature term for v equation 
axial-force coefficient 

drag coefficient due to vehicle with undeflected control surfaces 
total drag coefficient 

increment of drag coefficient due to viscous interaction 
hinge-moment coefficient 

lift coefficient due to vehicle with undeflected control surfaces 
total lift coefficient 

increment of lift coefficient due to viscous interaction 
pitching-moment coefficient due to vehicle with undeflected controls 
increment of pitching-moment coefficient due to viscous interaction 
yawing-moment coefficient due to vehicle with undeflected controls 
side-force coefficient 
mean aerodynamic chord, m (ft) 
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Cp specific heat for air, J/kg-K (Btu/lbm-°R) 

c s speed of sound, m/sec (ft/sec) 

DC^p increment in axial force due to viscous effects 

EA viscous axial exponent 

F term used for iterative process for viscous calculations, K (°R) 

Fp term used for iterative process for viscous calculations 

F x ,Fy»Fz forces along body axes, N (lbf) 

G x ,Gy,G 2 gravitational components along inertial axes, m/sec 2 (ft/sec 2 ) 

H q enthalpy, J/kg (Btu/lbm) 

h altitude, m (ft) 

I XX> I YY> I ZZ moments of inertia about body axes, kg-m 2 (slug-ft 2 ) 

I X z , iyz > ^XY products of inertia about body axes, kg-m 2 (slug-ft 2 ) 

J 2 second gravitational harmonic 

ip body reference length, m (ft) 

i^,m^,n^ direction cosines, i = 1, 2, 3 
M Mach number 

M x ,My,M z rolling, pitching, and yawing moments about body axes, N-m (lbf-ft) 
m mass of vehicle, kg (lbm) 

m x ,my,mz moments about body axes due to RCS thrusters, N-m (lbf-ft) 

Nrq Reynolds number 

P,Q,R relative roll, pitch, and yaw rates about body axes, rad/sec 

p,q,r inertial roll, pitch, and yaw rates about body axes, rad/sec 

Q stagnation heating rate, J/m 2 -sec (Btu/ft 2 -sec) 

q dynamic pressure, Pa (psf) 

REH distance from center of Earth to vehicle, m (ft) 

Rp equatorial radius of Earth, m (ft) 


65 



APPENDIX C 


Rp polar radius of Earth, m (ft) 

Rft ratio of Rg/REH 

R s radius of oblate Earth, m (ft) 

S wing area, m 2 (ft 2 ) 

T am b ambient temperature, K (°R) 

T w ,T w i iterative term used in viscous calculations, K (°R) . 

T X ,T Y ,T Z thrust components along body axes, N (lbf) 
t time, sec 

u b> v b> w b atmospheric velocities along body axes, m/sec (ft/sec) 

V atmospheric relative velocity, m/sec (ft/sec) 

Vjhert inertial velocity, m/sec (ft/sec) 

Vp Earth relative velocity, m/sec (ft/sec) 

V WX RG> V WY RG» V WZ RG atmospheric relative velocities along relative geocentric 
’ 5 ' axes, m/sec (ft/sec) 

V X ,V Y ,V Z velocities along inertial axes, m/sec (ft/sec) 

^X,IG>^Y,IG>^Z,IG velocities along inertial geocentric axes, m/sec (ft/sec) 

V X rq,V y RG’^Z RG Earth relative velocities along relative geocentric axes, 

m/sec (ft/sec) 

v hypersonic viscous parameter 

v c viscous effect ignored when hypersonic viscous parameter below v c 

^X,RG>%,RG>^Z,RG wind components along relative geocentric axes, m/sec (ft/sec) 
X,Y,Z components of position along inertial axes, m (ft) 

X^Y^Zb components of position along body axes, m (ft) 

X IG, Y IG, Z IG components of position along inertial geocentric axes, m (ft) 

x off » Y off > z off center-of-gravity offsets along body axis such that X 0 ff 

is positive forward, Y 0 ff is positive right, and Z 0 f Y is 
positive downward, m (ft) 

x rG,Yrg,Zrg components of position along relative geocentric axes, m (ft) 
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Zr ratio of Z/REH 

a angle of attack, rad 

3 angle of sideslip, rad 

y flight-path angle, rad 

6 a aileron deflection, (6 el - 6 er )/2, deg 

Sj3F body-flap deflection (positive downward), deg 

S e total elevon deflection, (6 el + S er )/2, deg 

6 el elevon deflection, left panel (positive downward), deg 

6 er elevon deflection, right panel (positive downward), deg 

S r rudder deflection (positive trailing edge left), deg 

6sg speed-brake deflection, deg 

e emissivity of material 

0 C longitude, rad 

0j inertial longitude, rad 

X geocentric latitude, rad 

]i gravitational constant, m3/sec 2 (ft3/sec 2 ) 

UA viscosity, kg/m-sec (slugs/ft-sec) 

p atmospheric density, kg/m3 (slugs/ft3) 

a Stephan-Boltzmann constant, J/sec-m 2 -]^ (Btu/sec-ft 2 - 0 R^) 

4> , 0 roll, pitch, and yaw angle about body axes, deg 
<j> c commanded roll angle, rad 

heading angle, rad 

oo Earth rotational rate, rad/sec 

Aerodynamic parameters: 

C D,<$BF increment of Cj) due to body flap 

^D,6e increment of Cp due to elevon 
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C D,5SB 

increment 

of 

CD 

due 

to 

speed brakes 

C L,6BF 

increment 

of 

c l 

due 

to body flap 

C L,6e 

increment 

of 

c l 

due 

to 

elevon 

C L,6SB 

increment 

of 

C L 

due 

to 

speed brakes 


' l 3 ,6SB 


' l <5a 


' l Sr 


J m r 


'n T 


'n* 


' n 8 


ac. 


3(pb/2V) 

ac x 

3(rb/2V) 

3C, 


, rad -1 


, rad~ 1 


33 


•, deg- 1 


increment of C t ^ due to <$sb> deg -1 


3 C-, 


3C, 

36^ 


deg -1 


■> deg -1 


3C 


m 


3 (qc/2V) 


, rad - 1 


C m,6BF 

increment of 

Cm 

due 

to 

6 bf 

c m,6e 

increment of 

Cm 

due 

to 

«e 

c m,6SB 

increment of 

Cm 

due 

to 

5 sb 


3C 


n 


3(pb/2V) 

3C n 

3(rb/2V) 
3C 


■'n 


33 


■» deg 


, rad -1 


, rad -1 


-1 
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C ng,6SB 

increment of 

c np 

due to speed brakes, 

Cn 6a 

= derl 



° n 6r 

8C n 

= , deg" 1 

as r 



° Y e 

ac Y 

= — -.» deg -1 
30 



Cy 3,6sb 

increment of 

C Y$ 

due to speed brakes, 

° Y 6a 

3Cy 

= sT a ’ 



° Y 6r 

ac Y 

= 5T r ’ deg '’ 




T~ 1 


A dot over a symbol indicates a derivative with respect to time t. AG 
before a stability or control derivative represents a multiplying factor for 
perturbation studies of that derivative. 


Total Lift and Drag Coefficients 

C LT = gc L c L + C LV + GC L,<5e C L,Se + GC L, SSB C L, 6SB + GC L , <$BF C L , 6BF 
G DT = gc D c D + C DV + GC D,Se c D,Se + GC D, <$SB C D, 6SB + GC D, 6BF C D, SBF 


External Force Equations (Body) 
3^ = qSCC^Y sin ® — C^p cos ®o/m + Ty/m 


= QS. 


( gc Y b c Y 6 + GC %,6SB C *g,6SB)e + **6^5^ + GCY Sa CY Sa 6a 


I m + Ty / 21 


i z = ~qS(C LT cos a + C DT sin + T z /m 


F X = ma x - T X 

Fy = may — Ty ^ Tjj = Ty = T z = 0 for current simulation 
F Z = ma z - T Z 
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Moment Equations '(Body) 


M x = qSbj^— ^GC lp C lp p + GG i r G i r ^ + ^GC lp C^ + GCx^Ssb^Ssb) 6 + GCl 6a Cl 6a 6j 


+ GCl r. Cl p 6» 


' l 6r l 6r f 


+ m x + Z Q ff F Y - y off F Z 


My = qSc^GC m C m + C m y + — GC m ^C m ^q + GCm,6e G m,6e + GCfli,SSB G m,6SB 
+ Gc m,6BF c m,6BF] + m Y + x off F Z - z off F X 


M z = qSb 


"( Gc ng c ng + GC n3,6sB Cn 3,6SB) 6 + ^ ( Gc n p c n p p + Gc n r c n r r ) + GC n 5 r G n$ r 6 r 
a + m z + Y off F x - X off Fy 


GC n6 a C n6 a 6 a 


Translational Equations (Relative Geocentric) 

^X,RG = l l a x + m 1 a y + n 1 a z 
%,RG = l 2 a x + m 2 a y + n 2 a z 
^Z,RG = l 3 a x + m 3 a y + n 3 a z 


Translational Equations (Inertial Body) 

P • • • 

V x = -sin X cos 9 iV Xj rg - sin QjVy } rg - cos x cos ®I^z,RG + G X 

• • • • 

Vy = -sin X sin ©i^rg + cos ®I V Y,RG ~ cos X sin + G Y 

v z = cos XV X> RG “ sln X ^Z,RG + G Z 


X = V X 
Y = V Y 
Z = V z 
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Rotational Equations (Inertial Body) 


where 



Rotational Equations (Euler Angle Rates) 

P = p - i-|(A + to) cos X - i 2 X + 13(60 + w) sin X 

Q = q - m-j (A + w) cos X - m 2 X + ^(Qq + w) sin X 

R = r - n-| (A + w) cos X - n 2 X + 03(62 + to) sin X 

4 = P + (Q sin <|> + R cos 4>)/tan 9 

0 = Q cos (() - R sin (j) 

4) = (Q sin <j> - R cos <j>)/cos 0 

Velocity Equations (Inertial Geocentric) 
V X,IG = -V X sin X cos 0j - Vy sin X sin 9y + Vz cos X 
%,IG = -Vx sin ©X + Vy cos 0j 

V Z»IG = “ V X cos X cos 0j - Vy cos X sin 0j - Vy sin X 

Velocity Equations (Relative Geocentric) 
V X,RG = V Xf iG 

V Yj rg = Vy ? ig •“ REHoo cos X 
V Z,RG = V Z,IG 
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Velocity Equations (Atmospheric Relative) 

V WX, RG = V X,RG “ W X,RG 

V WY, RG = V Y,RG “ W Y,RG 

V WZ, RG = V Z>RG - W Z>RG 

Velocity Equations (Body) 

u b = VwXjRGM + v WY,RG l 2 + v WZ,RG l 3 
v b = v WX,RG m 1 + v WY,RG m 2 + v WZ,RG m 3 
w b = v WX,RG n 1 + v WY,RG n 2 + v WZ,RG n 3 


Direction Cosines 

1 1 = cos \|> cos 0 

12 = sin \|> cos 0 

13 = -sin 0 


m-j 

m2 

m3 

n 1 

n 2 

n 3 


= cos \p sin 0 
= sin \J> sin 0 
= cos 0 sin <{> 
= cos \j) sin 0 
= sin ^ sin 0 
= cos 0 cos $ 


sin <|> - sin cos <j> 

sin <|) + cos cos (|) 

cos <J) + sin sin <j> 

cos <|) - cos sin <|> 


Auxiliary Equations 

V = ^Ufc 2 + V5 2 + W5 2 

V R = \/ V X, RG + V Y,RG + V Z,RG 
a s tan -1 (w^/u^) 

3 = sin -1 (v b /V) 
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2 2 
Y = tan -1 1 -Vz,Rg/ pX,EG + V Y,RG 


= tan" 1 (V y ,rg/Vx,Rg) 


V INERT = ]/ V X 2 + V Y 2 + V Z 2 


q = 0.5PV2 

n Rs = pvi b /y A 

M = V/c s 

h = " V Z,RG 

©X = tan- 1 (Y/X) 

6q = ©x — tot 
A = cos ^ 


Earth Model and Gravitational Equations 
The Earth model is shown in the following sketch: 



South Pole 
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REH = ^X 2 + Y 2 + Z 2 
X = sin" 1 (Z/REH) 

R s = R E [l + (k - 1) sin 2 x] (k = (R E /R P ) 2 ) 

h = REH - R s 
Z R = Z/REH 

R r = R E /REH 

The gravitational equations are as follows: 

G x = -y(X/REH3)£l + JR R 2 (1 - 5Z R 2 )] 

Gy = -d(Y/REH3)[i + JR R 2(1 - 5Z R 2 )] 

G z = -u(Z/REH3)[i + JR r 2 (3 - 5Z R 2 )] 

where 


J 2 = 1 , O8263O x 10-3 
U = 3.986009 x 10 14 


Viscous Equations 

H 0 = c p T amb + ^/2 

Q = 8.8484 x 10 6 \Jp (V/ 3048 )3 - 07 

f - ~T W + Cl - c p(T w /H 0 )^]^ 

F p = -1 - O.25Cl[c p (Q/H o )]y^Q0 - c p (T w /H 0 )]J 

^wi = (T w - F/Fp) (Starting with T w = 556 K, iterate on T w until 

| T w1 " T w | £0.56 K) 


T w = T w1 

C ' = \fVWT amb + 110.4 )/(T w + 110.4) 
v = M \|C VN Re 
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v R = v/v c 

Cap = GCpCj) cos a - GC L C L sin a 
dc AF = Q v r) EA - l] c AF 


re 


C mV = 0.11 583825DC ap I 
Clv = -DCaf sin a ^ 
Cpy = DC^p cos a 


^mV> ^LV* anc * '-'DV are se ^ 
equal to zero when the viscous 

calculations are not used 


Cl = (1/ea)°- 2 5 = 68.52 (sec-m 2 -K 4 /J) 0 - 25 (1272.99 (sec-ft 2 -°R 1J /Btu) 0 - 25 ) 
e □ 0.8 

c p = 1004.16 J/kg-K (0.24 Btu/lbm-°R) 

EA = 0.636 
v c = 0.007 
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Figure Cl.- Flow of variables for equations of motion. 




















AERODYNAMIC VISCOUS INITIAL CONDITION TRANSFORMATION 
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Figure Cl.- Concluded. 
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CONVOLUTION INTEGRATION TECHNIQUE 

Lawrence E. Barker and Lawrence F. Rowell 
Langley Research Center 


The integration technique described is for the solution of linear differ- 
ential equations with constant coefficients. The primary advantages of this 
technique are (1) the stability of the solution, (2) the high degree of accuracy 
for large system roots, (3) the variety of difference equations possible from 
this method of implementation, and (4) the ease in programing solutions to trans- 
fer functions when using the available subroutines. The symbols which follow 
have been used in the description of the integration procedures: 

A n x n matrix of system state coefficients 

B n x r matrix of forcing function coefficients 

b nth-order vector of forcing function coefficients 

C constant gain matrix 

D,E coefficients of states when coefficient of x is one 

G constant gain matrix 

h integration interval size, sec 

K constant gain matrix 

n order of highest order derivative in system 

P(h) constant matrix e^h 

Pi 1 >Pl2>P21 >P22 elements of matrix P(h) for a second-order system 
Q(h) 3x3 matrix of coefficients for three- term Taylor series 

qi,q 2 ,C 3 elements of q^ for a first-order system 



elements of q^ for a second-order system 


q^(h) vector values of Q(h), where i = 1, 2, 3 

r number of forcing functions into system 
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s Laplace operator 

t time, sec 

t^ discrete sample time, t = kh where k = 0, 1, 2, . . » 

u(t) scalar forcing function input to a transfer function 

u( t ) rth-order vector representing forcing functions 

u*(tk) vector of three terms resulting from Taylor series 
W single element of matrix A for a first-order system 

x(t) scalar solution state for a first-order system 

x(t) n-dimensional vector representing system states of a dynamic system 

y(t) scalar output that results from y(t) for single output transfer 

function 

y(t) nth-order vector of multiple outputs of a transfer function 

Z Z-transform operator 

x dummy integration variable 

A dot over a symbol indicates the derivative of the quantity with respect 
to time t. A double dot represents the second derivative with respect to 
time t . 

The behavior of a linear system can be described by a set of first-order 
differential equations of the form 


x(t) = Ax( t) + Bu(t) (D1) 

where x(t) is the nth-order vector describing the system states, u(t) is an 
rth-order vector representing the forcing functions, A is an n x n matrix, 

B is an n x r matrix, and x(t) is the time derivative of x(t). The well- 
known solution (ref. 4) to equation (DO is 


x(t) 


e^oc(0) + 


C e A(t-T)Bu(T) dx 


(D2) 


where e At is called the transition matrix and T is a dummy integration vari- 
able. For digital (discrete) systems, the sample time is represented by tg 
and equation (D2) becomes 
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x(tK + h) 


P(h)x 



P(h - T)Bu(tK + dT 


(D3) 


where h is the integration step size and P(h) = e Ah . Equation (D3) provides 
an exact solution; however, in a digital simulation, the value is estimated on 
the basis of a knowledge of u(t) at discrete sample times. The solution of 
equation (D3) can be obtained by several approaches. The convolution integra- 
tion technique is a numerical-analytical method derived by approximating the 
system forcing function u(t) with a Taylor series as it appears under the con- 
volution integral in equation (D3). This technique is a special case of the 
local linearization described in reference 5. 

Since systems defined in transfer function form will include a forcing func 
- tion in only the highest order derivative, u(t) can be treated as a scalar 
input u(t), and B becomes 


0 

0 


b 


0 


1 


Jnxl 


Therefore, equation (D1) becomes 


x(t) = Ax(t) + bu(t) 
and equation (D3) becomes 


(D4) 


x(t K + h) = P(h)x(t K ) + J* P(h - T)bu(t K + T) 


dT 


(D5) 


By retaining three terms of the Taylor series, the resulting difference equation 
is 


where 


x(t K + h) = P(h)x(t K ) + Q(h)u*(t K ) 
P(h) = e Ah 

Q(h) = j^q 1 (h),q2(h),q3(h)J 


(D6) 
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and 


U*(t£) = 


U(tfc) 

u(t K ) 

u(tg) 


The vectors qp where i = 1,2, and 3, are defined by 

1 f h . 

qi (h) = — \ p(h - xHi-Hdt 

(i - 1)! 

The change in the state space, vector x(t) is the linear sum of P(h)x(tf(), 
qi(h)u(tg), q2(h)u(tp[) , and ( h) Ci( tg;) » The only approximation in equa- 
tion (D6) (see ref. 6) is the representation of the forcing function between 
sample points. Equation (D6) can be obtained also as a specific case from a 
more general algorithm derived by the method of local linearization applied to 
a nonlinear system of equations (ref. 5). 


The constants P(h) and Q(h) are functions of the system roots and the 
integration step size, and their analytic expressions have been programed into 
subroutines for first- and second-order systems. The method adopted for solving 
third- or higher-order systems is to break them down by partial fractions into 
first- and second-order systems and then to solve the resulting systems by par- 
allel programing. The constants P(h) and Q(h) ensure correct placement of 
the continuous system roots, and their calculations need be performed only once 
before the integration is begun. A representation of the state variable formu- 
lation for a single input, multiple output system is as follows: 


INPUT STATE OUTPUT 



Given the system described by equation (D4) , the output equation is 

y(t) = x[cx(t) + Du(tJ (D7) 

where C, G, and K are gain matrices. 
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The programing concept described here differs from numerical integration 
in that information on the forcing function is supplied to the integration 
routine, and the resulting solution is used in an algebraic "output equation." 
Numerical techniques require calculation of an algebraic derivative equation, 
and the result is passed to the integration routine to be used with past infor- 
mation in calculating the solution. When solving a transfer function, the 
result of integrating by the convolution technique is to solve the corresponding 
transfer function as if it had a numerator of 1 . The output equation is used to 
account for the "numerator dynamics" and thus complete the solution. 

Table DI and table DII give a reference to the output equations for some 
common first- and second-order transfer functions, respectively. The. derivative 
equation shown at the top of each table is just one of the possible output 
- equations. 

Linear first-order systems are described by 
x(t) + Wx(t) = u(t) 

where W is the negative of the system root, u(t) is the forcing function, and 
x(t) is the solution state. The transfer function representation of the first- 
order system and the convolution equations are as follows: 


u(s) 

1 

x(s) T 


S + W 

. J 



x-|(t k + h) = P(h)xi ( tg) + q-|u(t{() + qgu.Ctfc) + qg^iCt^) 
x(t£ + h) = u(t£ + h) - Wx-| (tg + h) 
where P(h) = e”Wh 


q 1 = (1 - P)/W 
q 2 = (h - q^/W 



The derivative x(t) can be calculated if velocity is required as an output or 
for limiting purposes. 

Linear second-order systems are described by 
x(t) + Dx(t) + Ex(t) = u(t) 
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where D and E are the coefficients of the states when the coefficient of 
x(t) is one. The second-order convolution equations and the transfer function 
representation are as follows: 


u(s) 

1 

x(s) 


s 2 + Ds + E 



x-|(t K + h) - piix-jU^) + Pi2 x 2^ fc K^ + qilu(tK> + qi2 u ( fc K) + q^u^) 
x 2 (t K + h) = P 21 x 1 <t K ) + P22 x 2^k) + Q21^ t K) + Q22 u ( t K) + 

x(tjf + h) = u(t£ + h) - Dx 2 (tg + h) - Ex-j (tg + h) 

where p's and q's have equations that differ with the type of roots, that 
is, complex, real and equal, or real and unequal. 

By varying the method of computing u(t) , u(t), and u(t) (that is, there 

is no restriction to use the values at time tg) , many different algorithms can 
be developed for digitally representing a filter transfer function when the fil- 
ter specification is in analog form. The choice should depend on the applica- 
tion, the method of computing, or the system to be simulated. 

For example, to model the first-order system W/(s + W), three of the many 
possible algorithms that can be developed are as follows: 

Case (a) 

x(tg + h) = e“ Wh x(t£) + (1 - e" Wh )u(tK> (u = u(tg); u = u = 0) 

This difference equation corresponds to the Z-transform (1 - e - Wh)/(Z - . 

Case (b) 

x(tg + h) = e“^x(tg) + (1 - e“^* 1 )u(tK + h) (u = u(tj£ + h); u = u = 0) 

This equation corresponds to the Z-transform (1 - e“^* 1 )Z/(Z - e”Wh). 

Case (c) 

u(tg) + u(tg + h) 

x(t^ + h) = e _Wh x(t^) + (1 - e“ wl1 ) — — 

/ u(t K ) + u(t{£ + h) \ 

l u = ; a » u = 0l 
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This equation corresponds to the Z-transform (1 - e _ W h )(Z + 1)/2(Z - e _Wh ) 
where Z is the Z-transform operator. 

For each of these cases, the roots of the continuous system are matched. 

The differences are in the reconstruction of the forcing function u(t) which is 
treated separately from the stability of the process. In these examples, u 
and u were not used; in many applications, u is available within the program 
or can be approximated with a difference equation resulting in many more pos- 
sible algorithms and improved accuracy. 

There are other methods for deriving algorithms for modeling the transfer 
function W/(s + W) . There are substitution methods for the Laplace operator s 
(Tustin, for example, which is the equivalent to case (c) above with a Pade 
approximation made for e“Wh). Also, a numerical integration scheme such as rec- 
-tangular or Euler could be used. These methods give an approximation on the 
placement of the continuous system roots, but for hW « 1 , the results from all 
of these would be similar. 

Equation (D6) has been programed for first- and second-order systems in 
subroutine form to make the use of the convolution technique quick and flexible. 
Thus, a programer can solve most linear transfer functions by, first, using a 
partial fraction decomposition to reduce his system to the first- and second- 
order blocks; next, using subroutines to calculate the constants; and, finally, 
using the integration subroutines and output equations to calculate the solution 
of the system. 
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TABLE DI.- CONVERSION OF TRANSFER FUNCTIONS TO OUTPUT EQUATIONS 

FOR FIRST-ORDER SYSTEMS 
^Forcing function is u(t^) 

State equation: 

x = x-|(t K + h) - P(h)x(t K ) + q-| (h)u(t^ ) + q 2 (h)u(t K ) + qjChMtg) 
First derivative: 

x = x 2 (t K + h) = u(tg; + h) - Wx-|(t{( + h) 


Transfer function 


Output equation 

1 

s + W 

y(tg + h) = x-| (tf[ + h) 

K 



s + W 

y(t K + h) = Kx-|(t K + h) 

Ks 

s + W 

y(t K + h) = Kx 2 (t K + h) 

= K ju( tg + h) - Wx-|(t K + h)J 

K( As + B) 
s + W 

y(tg + h) = KAx 2 (t]£ + h) + KBx-|(t£ + h) 

= k[(B - AW)x-i(t K + h) + Au(t K + h)] 
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TABLE DII . - CONVERSION OF TRANSFER FUNCTIONS TO OUTPUT EQUATIONS 

FOR SECOND-ORDER SYSTEMS 

State equations: 

.# . •> 

x = x 1 (t K + h). = Piix-|(t K ) + Pi2 x 2(tK) + qnu(t K ) + q 12 u(t K ) + qi 3 u(t K ) 
x = x 2 (t K + h) - p 2 |X-| (t^) + P22 x 2( fc K) + Q21 u (tK) + Q22 u ( fc K^ + 

Second derivative: 

x = xjCtjf + h) = u(tg + h) - Dx 2 (tg + h) - Ex-|(tg + h) 


Transfer function 

Output equation 

1 

s 2 + Ds + E 

y(t{( + h) = xi(t£ + h) 

K 

s 2 + Ds + E 

y(t K + h) = Kx-](t K + h) 

Ks 

s 2 + Ds + E 

y(tg + h) = Kx 2 (t K + h) 

K3 2 

s 2 + Ds + E 

y(t^ + h) = KxgCtfc + h) 

= K[u(t K + h) - Dx 2 (t K + h) - Ex-((t K + hjj 

K(s + A) 
s 2 + Ds + E 

y(tff + h) = K |ax i ( tf[ + h) + x 2 (t£ + h)J 

K( As 2 + Bs + C) 
s 2 + Ds + E 

y(tjj + h) = K^Ax^t^ + h) + Bx 2 (t£ + h) + Cx-|(t£ + h)j 
= K[Au(t K + h) + (B - AD)x 2 (t K + h) 

+ (C - AE)x-| (t K + h)J 
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ARFDS PROGRAM LISTING 

The ARFDS program listing is given in this appendix. 


000003 

000003 

000003 

000003 

000003 

000003 

000003 


000003 

000003 

000003 

000003 

000003 

000003 

000003 

000003 

000003 

000003 

000003 

000003 

000003 


000003 


000003 


PROGRAM ARFDS I 1 NPUT *201 , OUT PUT*20l » TAPE33* INPUT 1 

£***** 

AUTOMATIC REENTRY FLIGHT DYNAMICS SIMULATOR THIS PROGRAM 

C***** MILL STUDY THE CAPABILITY OF THE SPACE SHUTTLE CONTROL SYSTEM 
C***** ANO GUIDANCE SCHEME TO FLY THE VEHICLE TO A TARGET. 

£*«*** 

EITHER OBLATE OR SPERICAL EARTH MODELS MAY BE SELECTED. 

C***** INPUT QUANTITIES WILL BE IN THE GEOCENTRIC REFERENCE FRAME. 

C***** THE CONSTANTS AND VARIABLES USEO IN THIS PROGRAM ARE IN 

£*«*** ENGLISH UNITS. 

COMMON/ RE ALTIM/ADCC40I .OACC 961 ,LOI S 1 4 108) , LOI SO! 1801 . 

LNOPERt NHOLD* NRESET *NTERM *NPRINT » NREAD 
COMMON/ 1 NT COMM/ T ,H* INT f NEQi I SCHEME * DER INT 4 2*151 
COMMON/ INT INTR/ I NTERN! 5 • 15 1 
COMMON/CCONAi/ HI «NEQl tCONi ( 10 ,6 1 
COMMON/ TABLES/ TABLE 4 1001 > INTEG! 101 

COMMON/ ORI V ER/ ALPDG, MACH, DEL SB* DELE * DELBF* DELEL* OELER 
COMMON/ FUNCNAM/CL «CD*CM * CYB.CNB* CLB *CYOR*CLDR *CNOR *CLE « CDE *CME * 
ICYDA, CLDAvCNOA* CL S8* CDS B * CMS6*CYS$B,CN8SB vCLBSBvCH SB* CHR* CHB* CMQ* 

2 CNR , CLR *CNP « CLP * CLBF * CDBF * CMBF * C HBF , CHER * CHEL 
C 

REAL MACH,MACHL, L,M,NvLODl,LMN 
C 

DIMENSION I VARBUF451 vLOGICI 51 

DIMENSION TABTAB 14 91 , TABTA82491 *TABTAB34 91 

DIMENSION TABIA451 ,TAB2A46) ,TAB22A!4)« TAB4A! 5) * TA85A! 5 1 *TAB55A(4l , 
1TAB6A4 5 1 »T ABBA 4 6 1 
DIMENSION OL I M I TR 4 2 1 , OL I M I T£ 4 2 1 
DIMENSION RLIM IT012 1 ?RL IMITL! 2) t RL IMITR! 2 1 
DIMENSION RECi 43,31 
DIMENSION XYZE 431 

DIMENSION CIGAR! 3, 31 ,TA 4 31 , TAPI 31 , TARE 431 ,UTARE431 , UXYZE431 
DIMENSION REC43,3 ) , RG4 3 1 ,RGP (31 
DIMENSION ANSW48J 

C 

LOGICAL L D I S I , L 0 1 S 0 , L 0 G I C 

LOGICAL VARCHNG, INTABLS, AUTOTYP, TYPESW .ENABLE 
C 

THESE EQUIVALENCES SET UP EASY ACCESS TO THE VARIABLES THAT 
C+**** WILL BE CHANGED FROM THE CONTROL CONSOLE BETWEEN CASES. 


EQUIVALENCE 

(TABLE! 

11 

, CHORD 

1* (TABLE! 

2) 

• SPAN 


1,4 TABLE 4 

3 > * S 

1, (TABLE! 

41 

, RNREF 

1, (TABLE! 

51 

* WE IGHT 


2, (TABLE! 

61, EX 

1* (TABLEC 

71 

tEY 

1, (TABLEC 

8) 

* EZ 


3* (TABLE! 

9 1 *EXZ 

1,1 TABLE! 

101 

, EXY 

)« (TABLE! 

ll) 

* EYZ 


4, (TABLE! 

121 « XOFF 

), (TABLE! 

131 

, YOFF 

1, (TABLE! 

14 1 

, ZOFF 


5, IT ABLE 1 

151, TIC 

1, (TABLEC 

161 

•CNGRATEI t (TABLE! 

17) 

•OFTEN 


6*4 TABLE! 

181 *PDGIC 

1* (TABLE 4 

19) 

* QDGIC 

), (Tables 

20) 

, RDGIC 


7 » (TABLE! 

21 1 , PHI DGIC I,! TABLE! 

22} 

,VIC 

1, STABLES 

23) 

* PSI E01C) 

8* ! TABLE4 

241 *ALPDGIC), (TABLE! 

251 

tBETDGICIt (TABLE! 

261 

* GAMDGI C ) 

9* 4 TABLE! 

27 1 *GCLDGIC i « 4 TABLE! 

261 

t RLONDIC) » S TABLE ( 

291 

*HAIC 


1 , 1 TABLE! 

301 , RE 

1, (TABLE! 

311 

*C1 

1 * (TABLE! 

32) 

♦ C2 


2* ! T ABLE! 

33 1 * DELA IC 

), (TABLE! 

341 

• DELR IC 

1 * (TABLE! 

35) 

• DELEIC 


EQUIVALENCE 








1 (TABLE! 

36 1 * WXRG 

1, (TABLE! 

371 

, WYRG 

), (TABLE! 

38) 

* WZRG 


2* (TABLE! 

39) *GCLP 

1 * (TABLE! 

401 

, GCLR 

1* (TABLE! 

41) 

, GCL 8 


3* (TABLE! 

42 1 *GCLDA 

1, (TABLE! 

43) 

, GCLDR 

), (TABLE! 

44) 

*GCM 


4* (TABLE! 

45 ) *GCMQ 

1,4 TABLEC 

461 

,GCME 

1* (TABLE! 

47) 

s&CNB 


5 * ! T ABLE4 

48 1 *GCNP 

1 • (TABLE! 

49) 

* GCNR 

1 * (TABLE! 

50) 

,GCNDR 


6* ( TABLE4 

51} *GCNDA 

1, (TABLE! 

52) 

« GCL 

1* (TABLE! 

53) 

* GCD 


7, 4 TABLE! 

541.GCLE 

1, (TABLE! 

55) 

*GCDE 

) *4TABLE( 

56) 

• GCYB 


8*4 TABLE 4 

57 ) *GC YDR 

}, (TABLE! 

58) 

• GCYDA 

) * ( T ABLE ( 

59) 

• GCLBF 


9* ( T ABLE! 

601 *GCOBF 

1, (TABLE! 

61) 

* GCMBF 

), (TABLE! 

62) 

*GCH9F 
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000003 


U00003 


000003 

000003 


000003 


000004 

000004 

000004 

000004 

000004 

000004 

000004 

000004 

000004 

000004 

000004 

000004 

000006 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 

000007 


A » ( T ABLE ( 631* GCL SB ) , ( TABLE ( 64),GCDSB ), (TABLE! 631 * GCM SB I 

8 * ( T ABLE! 66),GCYBSB ), (TABLE! 67i*GCNBSB I * (TABLE! 68),GCLB$B ) 

C * ( TABLE! 69 ) * GCHSB ), (TABLE! 701.GCHE ), (TABLE! 71) ,GCHR ) 

D. (TABLE! 72),GCHB ), (TABLE! 73)#GUI00T } * (TABLE! 74I,0ELNDIC) 


EQUIVALENCE! INTEG! 1),N0UT ) « ! I NT EG! 2 ) » NRUN ) 

It! INTEG! 31 » I0ELT ), (INTEG! 41,ISKEM ) *( INTEG! 5),ISLECIC) 
2*1 1NTEG! 6) * JSC AN )*!INTEG( 7),NSTRT ) 


C 

£***** 

£***** 


THE OERINT ARRAY CONTAINS THE DERIVATIVE A NO INTEGRAL NAMES 
OF ALL THE VARIABLES TO BE INTEGRATED BY THE NUMERICAL SCHEME 
IN SUBROUTINE IGRATE1.THE VAR I ALES IN ROW l ARE THE INTEGRALS 
OF THOSE IN ROW 2* 

OT ) 


EQU I VALENCE (DER I NT! 1, 

1),P ), 

(DER INT! 2, 

11 

l , ( DERINT ! 1 

, 2 ) , Q 

I , (DER INT (2, 

21, QDOT 

I 

2, ! OERINT ( 1 

, 31, R 

) » (DERINT (2, 

31, ROOT 

I 

3 , ! DER INT ( 1 

, 41 * PHI 

),! DERINT! 2, 

4), PH I DOT 


4,! DERINT! 1 

, 5), THE 

) , (DERINT (2, 

5) , THEDOT 


5* (DERINT ! 1 

, 6) , PS I 

),( DERINT! 2, 

6) ,P$IDGT 


6 * ( DER INT ( 1 

, 7) * VX 

) , ! DERINT (2, 

7) , VXDOT 

1 

7, (OERINT! 1 

, 8) , VY 

) , (DERINT (2, 

8) , VYOOT 

) 

8, (OERINT!! 

, 9) , VZ 

1,1 DER INT (2, 

9 ) , VZDOT 


9, ( DER INT (1 

,10),X 

) « ! OERINT 1 2, 

10) , XDOT 

1 

A,( DERINT! I 

tin ♦ y 

), (DERINT! 2, 

11), YOOT 


B, (DERINT! 1 

, 12) * Z 

J * (DERINT ! 2, 

12) , ZDOT 


C,1 DERINT!! 

, 13) , ERALl 

)* (DERINT! 2, 

13 ) , ERRALPD) 

D, ! DERINT 1 1 

*14) ,EA2I 

1 , (DERINT (2, 

14I.EA2 

> 

E, (DER INT (1 

, 15) , EY5I 

) , (OERINT ( 2, 

15J.EY5 

1 


C 

C***** THESE EQUIVALENCES ARE USED BY THE TYPEWRITER SOFTWARE WHEN 

C***** TYPING OUT THE CHAGES TO VARIABLES MADE AT THE CONSOLE. 

EQUIVALENCE (LDISU46! , AUTQTYP I , 1LD1SI ( 471 * TYPES*) 

EQUIVALENCE ( L 01 $ I ( 48 1 * I NT ABL S ) 

C 

C***** THIS IS AN ENTRY POINT TO SUBROUTINE OATAFUN WHERE THE AERO 

C ***** FUNCTION DATA IS READ AND PACKEOiTWO DATA POINTS PER WORD). 

CALL DATAIC 


C 


C***** THESE DATA STATEMENTS SET UP FUNCTIONS TO BE USED WITH AERO- 

C***** DYNAMIC INTERFERENCE CALCULATIONS OF EMX, EMY* AND EMZ. 


DATA TABTAB1/0. ,20. *20. * 0. *5. ,4*0./ 

DATA TA8TAB2/0.,5.,20.,0.,2.5,5.,5.,2*0./ 

DATA T ABTAB3/0. * 5. *10. *-2. ,3. *0. *3. *30.* 20. / 

DATA TAB1A/ .746, .63* .533, .475, .436/ 

DATA TAB2A/-. 624,-. 953, -1.069, -I. 069,-1. 069,-1. 069/ 

DATA TA822A/-. 701, -.934,-1. 166,-1.069/ 

DATA T AB4A/ . 74 , . 6 16 , . 541 ,.512,. 493/ 

DATA TAB5A/0., .076 114, .133,. 152/ 

DATA TAB55A/ .076, .076, .076, . 152/ 

DATA TA86A/.13, • 192,. 23, .244, .253/ 

DATA TAB8A/-.141,-. 115,-. ill,—. 111,—. 1 11,— .111/ 

TAB3-1. 

TAB7*1.G2 

C***** THESE ARE CONSTANTS THAT WILL BE USED IN THE GUIDANCE SCHEME. 
DATA GS/32.2/ 

DATA CNMFS/ 1 .6457883E-04/ 

DATA ATK/3437. 746771/ 

DATA GST ART/. 05/ 

DATA RPT/227.8/ 

OATA VSAT/25766. 1973/ 

DATA VQ/7000./ 

OATA ALMN1/. 7986355/ 

OATA ALFM/25./ 

OATA RPT1/12.5/ 

OATA RAZ /-O. 7679448709/ 


DATA RTE /20909773.5/ 
DATA D8AR /48Q00./ 

DATA RTURN /15200./ 

OATA ALMN2/ 0. 9659258262/ 
DATA EEF4/2 000000./ 

DATA OF /I 9. 09/ 
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000007 
000007 
0000 LI 
000013 


000015 

000016 

000022 

000024 

000026 

000036 

000054 
000056 
000057 
000060 
00006 L 
000062 
000063 


000064 
000065 
000075 
0001 05 
000115 
000125 
000135 
000145 
000151 
000154 
000164 
000174 
000204 


000210 
000212 
000215 
0002 16 


000221 

000225 

000226 

000227 

000230 

000231 

000232 

000233 

000234 

000235 

000236 

000237 

000240 

000241 

000243 

000244 

000245 

000247 

000250 

000251 

000253 

000254 

000256 

000261 

000263 

000265 

000267 


OATA T ABLE/ 100*0./ 

VSAT$ = VSAT* VSAT 
S INRAZ*SIN4 RAZ 1 
C0SRAZ*CG$4 RAZ ) 

C***** THESE STATEMENTS SET UP THE HAROWARE CHANNELS TO BE USED 

C***** AND SPECIFY THE STATEMENT NUMBERS USED BY THE MODE CONTROLS. 

CALL NM218 4 5LT YPER1 

CALL XDSPLAY 4 LDI S I *LQ ISO* VARCHNG, I TYPE* I VARBUF* INTABL SI 
CALL CYCLE 490006S) 

CALL RTROUT E 4 MF * 90034S 1 

CALL INGUT( AOC » 0 « DAC * 16 * LD I S I * 48* LD I SO* 1801 

CALL OATABLXCTABLE* 100* INTEG* 10* LOG IC* 5* AOC *0*DAC* 16,LDIS I *48, 

1LDI SO* 180) 

CALL L0STIMEC9Q0I7S) 

ASSIGN 90001 TO NGPER 
ASSIGN 90002 TO NHOLD 
ASSIGN 90003 TO NRESET 
ASSIGN 90004 TO NTERM 
ASSIGN 90014 TO NPRINT 
ASSIGN 90015 TO NREAO 

C***** THESE STATEMENTS SPECIFY WHICH VARIABLES WILL BE PRINTED. THE 

£♦♦♦♦♦ FREQUENCY IS SPEC IF I EO BY NOUT. 

NOUT^l 

CALL READOUT ( 6 » NOUT * T * HA , GCLATOG * RLONDG * V , AN) 

CALL READOUT 46, NOUT, MACH* I SLECT, ACCEL, QB,PDG*QDG) 

CALL READOUT (6, NOUT, RDG,THEOG, PS IDG, TRANGE* BETDG.GAMDG) 

CALL REAOOUT (6 * NOUT, POOT , Q0GT , ROOT, PIT ERR,ERROLL,ERRYAW) 

CALL READOUT <6 , NOUT , ALPDG, PHIDG* DELE, DELA, DELR, DEL SB) 

CALL READOUT 4 6 * NOUT , DEL BF , ALPHAC , PH I CM , DLEC * OELAC * DELRC ) 

CALL READOUT <3 , NOUT ,NUDCTR, PS IEDG, VAI 
CALL REAOOUT 4 1 , NOUT , FUELUSE I 

CALL READOUT 46, NOUT, TROLNtTROLP, TPITN, TPITP,TYAWN, TV AWP) 

CALL REAOOUT 46 , NOUT * DEL ANUD ,RPRI * DE LEL * DEL ER, VBAR, V INERT) 

CALL REAOOUT 46 , NOUT , HMER , HMEL ,HMR, RU0R * ELERL * ELERR ) 

CALL RE AOOUT 4 3 ,NOUT * DR AG, HADOT ,E RRPHI I 
C***** THESE INITIALIZE LOGICAL DISCRETE OUTPUT AND INPUT CHANNELS 

C***** TO FALSE. 


DO 90007 INDEX-1 ,180 

90007 LDIS04 INDEX) = .FALSE. 

DO 90008 NDEX= 1 ,48 

90008 L01SI 4 NOEX) *. FALSE. 

C***** CONSTANTS SECTION 

C***** THESE CONSTANTS AND CALCULATIONS, DOWN TO STATEMENT 90003, ARE 
C***** ONES THAT NEEO BE DONE ONLY ONCE WHEN THE PROGRAM IS READ IN. 

C***** MANY VALUES INITIALIZED HERE CAN BE CHANGED FROM THE CONSOLE. 

LOGIC! 1 I*LOGIC 4 2.) =LOGIC 4 .3 1 - • F. 

J SCAN* 50 
NRUN*0 
NEQ*15 
ISKEM*! 

IDELT*25 

NEQi=6 

CONI 46, 1) **05 
CONIC 6,21 s . 05 
CONK 6*3) S 1 • 

CON 146,4|=.05 
CONI 46,5) *.05 
CONIC 6, 6) *2 • 

PI*3. 1415926535 
HPI*.5*PI 
TPI*2.*PI 
OTR*PI / 180. 

RTD*180./PI 

FTM*.3048 

PTS*1./32.174 

GE*32.217 

RL0NT*DTR*4-120.53381 
CQSLONT*CQS CRLONT ) 

SI NL0NT*SIN4 RLONT ) 

GCLATT*DTR*34. 55577617 
COSGCLT-COS ( GCLATT ) 

SINGCLT*SIN 4GCL ATT ) 
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000271 

000275 

000100 

000301 

000304 

000307 

000310 

000312 


REC I 1 » U*-C0SR AZ*SI NGCtT*C0St0NT 
REC<1,2J=-C0SRAZ*SINGCLT*$INL0NT 
REC41.3I* COSRAZ*COSGCLT 
REC (2, 11* SINRAZ*$INGCLT*CGSLONT 
RECI 2 ,2 I s S I NR AZ*S I NGCL T*S I NLONT 
REC42 , 3 l*-S INRAZ*CGSGCLT 
REC 43,1 >— COSGCLT *COSLONT 
R EC 4 3 , 2 J— COSGC LT*SI NLONT 


-SINRAZ*$INLQNT 

*SINRAZ*COSLONT 

-C05RAZ*S1 NLONT 
+COSRAZ*COSLQNT 


000314 

000315 


000334 

000337 

000343 

000346 

000352 

000356 

0Q0361 

000365 

000371 

000374 

000376 

000377 

000403 

000405 

000407 

000410 

000411 

000413 

•000414 

000416 

000417 

000421 

000422 

000424 

000425 

000427 

000430 

000432 

000433 

000435 

000436 

000440 

000443 

000444 

000447 

000450 

000452 

000453 

000455 


REC43,3*--SINGCLT 

DETERM-REC4 1, 1 )*(REC(2, 2 J*REC( 3,3)-REC42,3) *REC( 3,2) | 
1-REC4 2, II ♦( REC i 1 »2)*REC 43*3 ) -REC 4 1 , 3)*REC( 3 , 2 ) I 
2+REC43, it*4REC 4 1, 2I*REC 42, 3I-REC41* 3|*REC42#21 J 
Recm,i>-RECi2,2)*ReC43,3l-REC42,3l*REC4 3,2> 

REC1 4 1*2) -REC 4 1 » 3) *REC 43,2 }— REC 4 1»21*REC43,3I 
RECi4i,31=REC<l,2l*ReC42,3)-REC<l,3i*REC42.2) 

REC1 42*11 -REC 42 » 31*REC 4 3, 1 1— REC 4 2* 1 )*R£C43,3I 
RECU2,2J*REe4 it 1 I *REC4 3,3)-REC4 1,3 )*REC 4 3, 1 J 
RECU2*3)=REC4l,3)*REC{2,U-REC4 it 1 )*R£C< 2, 31 
RECl(3,ll*REC4 2»U*REC(3»2)-REC42,21*RECt3,U 
RECU3.2I-REC4 i,2)*REC43, U-REC4 1, 1 ) *R6C ( 3, 2) 

REC 1 < 3* 3) -REC4 l f l )*REC 42 ,2)-REC4 l, 2) *R EC 42,11 
DO 40 1-1,3 

DO 41 J-1,3 

REC 1 < I, Jl-RECUI, J* /DETERM 
41 CONTINUE 
40 CONTINUE 
NSTRT-0 
GUIDDT-.04 
CHQRO- 39* 5666667 
HCH0RD-„5*CH0RD 
SPAN- 78 *.05666666 7 
HSP AN- • 5*SP AN 
S-269Q. 

RNREF- 1 10*7 
WEIGHT-182986. 

EX-759000* 

EY-5765000* 

EZ-5912000. 

EXY-EYZ-O. 

EXZ-131 000. 

XQFF- ZOFF-O • 

YOFF-. 125 
DELBF — 11.7 
WXRG-WYRG-WZRG-0 • 

TIC-0. 

PDGIC-QOGIC-RDGIC-O* 

PHI DGIC— *15. 

VIC-26046. 

PSIEDIC-336.72 

ALPDG1C-34.25 

BETDGIC-O* 


000456 GAMDG IC=— * 84 

000457 GC LOG I C-47 . 84 

000461 RLONDI C-l 7*. 2 

000462 HAIC- 400000 • 

000464 DELA XC-O* 

000465 DELR IC-Q. 

000466 OELEIC-1. 

000467 I SLEC IC-Q 

000470 DELNDIC-O. 

000471 CNGRATE-O* 

000472 OFTEN-5. 

000473 GCLP-GCLR-GCLB-GCLDA-GCLOR-I, 

000500 GCM-GCMQ-GCLE-GCDE-GCME-GCL-GCD- 1. 

00050 7 GCNB-GCNP-GCNR-GCNOR-GCNDA-1 - 

0Q0514 GCLSB=GCDSB-GCMSB-GCYBS8=GCNBSB=GCLB$B=GCH$B=GCHR*GCHB-GCHE-1. 

000526 GCL BF* GCOBF* GCMBF-GCHBF— 1 • 

000532 GCYB-GC YDR-GCY DA-1, 

000535 GCLBF-GCDBF-GCMBF- 1 . 

000540 GCLS8-GCDSB=GCMSB=GCY8SB=GCN8SB=GCLBSB-1. 

000546 SLPAQ-7.5/20. 

000550 T I S PH- 750*/ 242* 
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000552 

000555 

000560 

000563 


000565 

000566 


000566 
000573 
000574 
000575 
000577 
000600 
000601 
0006j)2 
000604 
000605 
000606 
000607 
000610 
000612 
000613 
000616 
000620 
000622 
000623 
000624 
000625 
000627 
000632 
000635 
000637 
000641 
000644 
000646 
000652 
000660 
000667 
000671 
000672 
000675 
000700 
000703 
000706 
0007 U 
000714 
000721 
000722 
000725 
000726 
000727 
000730 
00.0732 
000733 
000734 
000735 
000740 
000742 
000745 
000747 

000750 

000752 

000753 

000755 

000756 


OLlMITRUJ*-22.8 401 1 MI TR 12) =22. 8 

01 IM JTE (I )*— 35. 401 IMITE(2I=2Q. 

C l*C2=l. 

HAMAX*500QQ0.*FTM 

C***** AFTER CALI READY, THE PROGRAM W ML LOOP IN SYNCHRONIZATION 
C***** WITH THE REAL-TIME CLOCK AS LONG AS THE MOOE SELECTED IS 

C***»* RESET, HOLD, OR OPERATE. 

CALL READY 
90003 CONTINUE 

RESET SECTION 

C***** THE RESET LOOP IS FROM STATEMENT 90003 TO 90050. WHILE THE 

C****+ RESET SWITCH IS DEPRESSED,ONL Y THOSE EQUATIONS ARE EXECUTED 

C***** NO INTEGRATION IS PERFORMED. 

LOISOl 1 11) S LDI SOI 1 12 )=LDISO( 113)=LDIS0< 114)*. F. 

SNT*0 

ISCHEME=ISKEM 
I SLECT* ISLEC IC 
I STRT*NSTRT 
I ST ART=0 
IFT-0 

IDFG2* IDFG3*0 
DELANUO*DELNOIC 
I STP=0 
8A1*0. 

VBB=20500. 

Y 9*. 30 54326 191 
TW=1000. 

H=i./ IDELT 
RATE! IM=H*2Q. 

RATLIMR*H*10. 

H1*H 

. HI * l . / H 
CALL PQ1 
DO 51 J=l,NEQl 
CONIC 1«J)=2B 
CONK 2 , J)=0. 

C0NK3* J)*0. 

C0NII4, J)*0. 

CONIC 5, J)=0* 

51 CONTINUE 

LATROL=LATPI T*L AT YAW=L ATDLA=0 

PITN=PITP=ROLN*RGLP=YAWN=YAWP*0. 

TROLN=TROLP=TPITN*TPITP*TYAWN=TYAWP=FUELUSE=0. 

QMAS$=WE1GHT*PTS 

OM ASS I =1 • /GMAS S 

TERMA=EY *EZ -EYZ*EYZ 

TERMB=£XY*EZ *EX2*EYZ 

TERHC=EXY*EYZ+EY *EXZ 

TERMD=EX *EZ -EXZ*EXZ 

T£RME=EX *EYZ+EXZ*EXY 

T E RMF= E X *EY -EXY* EXY 

D£T=EX*TERMA -EXY*TERMB -£XZ*TERMC 

0€TI*l./0ET 

PITERR*ERROLL=ERRYAW*0. 

ERRPH 1=0. 

DELRC=0. 

0£LAC=0. 

DLECL=DLECR*0. 

DELANUD=0. 

ERRAL PD*0. 

HMR=0. 

PASTD*PASTR=PASTL=0. 

RL IMITDC 1 )*RLIMI TDC 2)=0. 

ERALI*EA2I=EY5I=0. 

EA2=EY5=0. 

OMEGA*. 7292115 15 E-4 

C***** LOGIC 2 TRUE WILL GIVE A SPHERICAL EARTH WITH RADIUS RE. 

IF CLOG ICC 2 1 153 • 54 
53 OJ=Q. 

QMU=1. 40766268 6 E *16 
RE=20902910. 

RP*RE 



APPENDIX E 


000757 

000760 

000762 

000764 

000765 

000767 

000767 

000771 

000772 

000774 

.000775 

000777 

001001 

001003 

001005 

001007 

001011 

001012 

001014 

001015 

001017 

001021 

001023 

001024 

001026 

001027 

001031 

001032 

001034 

001035 

001037 

001042 

001044 

001046 

001050 

001052 


GO TO 55 

54 04*1.5*11.082639 E-3) 
OMU*i .4G7645794E+16 
RE* 2 09 2 5662 .73 

RP* 20855024. 2 

55 CONTINUE 
REORP*RE/RP 
REORPS=REORP*REORP 
RERPMi=REQRPS~i. 

T*TIC 

GCLAT*DTR*GCLDGIC 

RLON*DTR*RLONDlC 

P*DTR*PDGIC 

Q*DTR*QDGIC 

R*DTR*RDGIC 

PH I *DT R*PH I DGIC 

VR*VIC 

PSIE*DTR*PSIEDIC 

HA*HAIC 

ALPHA=DTR*ALPDGIC 

BETA*0TR*8ETDGIC 

GAMNA=DTR*GAMDG 1C 

D£LA=DELA1C 

DELR*OELRIC 

OELE=DELEiC 

D£LEL*DELE+DELA 

DELER*DELE-DELA 

Xi*DELEL 

X2*DELER 

X3*DELR 

ELERR*ELERL*RUDR*0. 
SINALP*SIN< ALPHA) 
COSALP*COS( ALPHA) 

S INBET*SIN( BET A ) 
COSBET*CGS< BETA) 

S INGAM* S INC GAMMA) 


001054 

001056 

001060 

001062 

001064 


001066 
001070 
001072 
001101 
001103 
001106 
001110 
001112 , 
001114 
001116 


001120 

001122 

001127 

001131 

001140 

001146 


001151 

001155 

001157 

001161 

001163 

001170 

001174 

001176 

001201 


COSGAN*COS< GAMMA) 

SINPHI*SiNCPHI) 

CO$PHI*CO$IPHI) 

SINPS I E*SIN ( PS 1EI 
COSPSI £*COS ( PS I E ) 

C***** CALCULATE COMPONENTS Of INERTIAL POSITION (X*Y,ZI FROM GCL AT « 

C***** HA,ANO RLON. 

SINGCL*SIN(GCLAT ) 

COSGCL*COSI GCL AT ) 

RS0*RE/SQRTC1. *RERPM1*S INGCL*S INGCL ) 

REH=RSO+HA 

RLONI *RLON ♦OMEGA*T 

COSLONI*COS ( RLON I ) 

S INLON I*S IN ( RLON I ) 

X*REH*COSGCL*COSLONI 
Y=REH*COSGCL*S 1 NCONI 
Z=REH*S INGCL 

C***** CALCULATE COMPONENTS OF INERTIAL VELOCITY (VX.VY.VZI FROM 

C***** GCLAT * RLON » GAMMA , P S I E 5 H At AND VR. 

VXIG* VR*COSGAM*COSPS IE 

VYIG* VR*COSGAM*S INPS IE +REH*OMEGA*COSGCL 
VZIG*-VR*SINGAM 

V X*— VX IG*SI NGCL*COSLONI ■- VYIG*SI NLONI -VZI G*COSGCL*COSLONI 
VY*-VX IG*S I NGCL*S INLONI *VY IG*COSLONI -VZ IG*CQSGCL*S INLON I 
VZ*VX IG*COSGCL - VZ IG*S I NGCL 

C***** CALCULATE THE INITIAL ANGLES CPSItTHE) FROM ALPHA * BE TA, PHI , 

C***** GAMMAA* AND PS I A (CONSTANT MINOS ACCOUNTED FOR). 

VYR 6 * VY IG -REH*OMEGA*COSGCL 
VWXRG* VXIG -MXRG 
VWYRG* VYRG -WYRG 
VMZRG*VZIG — WZRG 

VXVYR=SQRT( VHXRG*VWXRG *VWYRG*VWYRG ) 

GAMMAA=ATAN2i-VWZRG» VXVYR ) 

SI NGAMA*SIN< GAMMAA) 

P S I A=ATAN24 VttYRGt VWXRG ) 

SI NPSI A*SIN ( PS I A) 
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001203 
001205 
001211 
001215 
001226 
001232 
001234 
001236 
001242 
001246 
0012 52 
001255 
001260 


001260 


001260 

001262 

001264 

001265 

001271 

001275 

001301 

001305 

001311 

001315 

001315 

001317 

001321 

001322 

001325 

001327 

001331 

001333 

001335 

001337 

001341 

001342 

001350 

001351 

001352 

001354 

001355 

001357 

001364 

001370 

001372 

001374 

001404 

001410 

001412 

001414 

001416 

001421 

001423 

001425 

001430 

001431 

001434 

001436 

U01445 

001447 

001455 

001461 

001466 

001470 

001474 

001475 

001477 

001501 


CGSPSI A-COS (PS I A) 

81i=S INPHI*S INBET +CQSPHI *SINALP*COSBET 
63 =CO$ALP*COSALP*COSBET*COSBET +.611*611 
B13=CO$ALP*C0SBET*SINGAMA >B 1 l*$QRTI B3-SINGAMA+SINGAMA I 
THE =* AS INC 813/ B3 I 
SINTHE=SIN( THE I 
CQSTHE=COS( THE ) 

B17=C0SPHI*SINBET -SINPHI *COSBET*SI NAL P 
B18=CQSTHE*C0SALP*C0SBET +SINTHE*8li 
ZT=B1 8* SI NP SI A -B17+C0SPSIA 
ZB= B1 8+COSPS I A +BL7*SINPSIA 
PS I =AT AN2 ( ZT , Z B ) 

90002 CONTINUE 

C***** HOLD SECTION — - 

C***** WHILE THE HOLD SWITCH IS DEPRESSED, THE EQUATIONS BETWEEN 

C***** 90002 AND 90050 ARE EXECUTED. AGAIN»NG INTEGRATION IS PER- 

C***** FORMED. 

90006 CONTINUE 

O**** OPERATE SECTION ~— 

C***** WHILE THE OPERATE SWITCH IS DEPRE SSEO , THE EQUATIONS BETWEEN 

£****♦ 90006 AND 90014 ARE EXECUTED. THE CALLS TO IGR ATEi tCONVQl , AND 

C***** MODLAG PERFORM THE INTEGRATIONS. 

P0G*P*RTD 

Q0G-Q*RTD 

RDG»R*RTD 

I Ft ABSC PHI ) —PI ) 61 » 61 ,60 

60 PHI =PH I -SIGN! TP I » PHI I 

6 1 I F C AB S < THE ) -HP W 6 3 * 6 3 1 62 

62 THE=-THE + SIGN (PI , THE) 

63 IF! ABSI PS 1 1 -PI 165,65 * 64 

64 PSI*PSI —SI GNC TP I , PSD 

65 CONTINUE 

PHI DG» PHI+RTD 
THEDG=TH€*RTD 
P'S I DG=PS I*RT0 
SINPHI^SINC PHI) 

COSPHl^COSCPHI ) 

$INTHE=SIN< THE ) 

COSTHE=COSC THE) 

TANTHE=TAN( THE i 
SINPS I=SIN( PSI ) 

COSPS I=C0S(PS1) 

zs=z*z 

REH~SQRT<X*X + Y*Y >ZS) 

REHI-1 ./REH 
R E H I S =R EH I *R E H I 
REOREH=RE*REHI 
REOREHS*REOREH*REOREH 
ZOREHS =ZS +REHIS 

PZR=l, +QJ+ftE0REH5* ( 1.-5. +Z0REHS I 

OMPR=-OMU*PZR*REHIS*REHI 

GX I ®OMPR*X 

GYl=GMPR*Y 

GZI=OMPR*Z/PZR*U. +OJ*REQREHS*< 3.-5.+Z0REHS ) ) 

GCLAT=ASINCZ*REHI> 

GC L AT DG*GCL AT *RT D 
SINGCL*SINIGCLAT) 

COSGCL=COS I GCL AT ) 

RL0NI-ATAN2 I Y,XI 
SINL0NI*SINCRL0NII 
COSLONI*COS (RLONI ) 

RLON-RLQNI -OMEGA+T 
RLONOG*RTD*RLON 
SI NLON*$IN< RLONI 
COSLON*COS < RLON ) 

RSO-RE/SQRTU. +RERPMI*SINGCL*SINGCL) 

HA*REH-RSO 

VXIG=-VX*SINGCL*COSLONl -VY*SINGCL*SINLONI +VZ+CQSGCL 
VYIG*— VX*SI NLONI +VY+COSLONI 

VZI G“ — VX*CQSGCL*COSLONI -VY*COSGCL*SINLONI -VZ+SINGCL 
VXRG*VXIG 

VYRG*VYIG -REH*QMEGA*CGSGCL 
VZRG- VZIG 
EL i=CO$PSI*CGSTHE 
EL2 = S INPSI+COSTHE 
EL3--S INTHE 
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001502 

001505 

001510 

001511 

001515 

001517 

001521 

001523 

001525 

001527 

001535 

001543 

001551 

001557 

001565 

001570 

001572 

001574 

001576 

001600 

001604 

001606 

001613 

001617 

001621 

001623 

001625 

001630 

001632 

001634 

001636 

001640 

001641 

001643 

001644 

001646 

001647 

001655 

001661 

001663 

001665 

001667 

001671 

001674 

001676 

001701 

001703 

001705 

001711 

001713 

001714 

001716 

001717 


001721 

001722 

001725 

001727 

001727 

001731 

001733 

001735 

001737 

001743 

001755 

001762 

001767 

001777 

002002 

002006 

002010 

002010 


EM1*C0SPSI*SINTHE*SINPHI -SINP$I*C0SPHI 
EM2*SINPSi*SINTHE*$INPHI *CQSPSI*CQSPHI 
EM3*COSTHE*SINPHI 

ENi*COSPSl*SlNTHE*COSPHI ♦SINPSI *SINPHI 

EN2*SINPSI*$INT HE *C 05 PH l -C OS PS I *S I NPH I 

EN3=C0STHE*C0$PHi 

V WXRG* V XRG- WXR G 

VWYRG*VYRG-WYRG 

VWZRG*VZRG-WZRG 

UB*VWXRG*ELi *V«YRG*EL2 *VWZRG*EL3 
VB=VWXRG*EM1 *VWYRG*EM2 *VWZRG*EM3 
WB*VWXRG*ENi +VWYRG*EN2 *VWZRG*EN3 
V*SQRT(UB*UB *V8*VB +WB**B) 

VR*SQRT 4 VXRG*VXRG *VYRG*VYRG *VZRG*VZRG) 

ALPHA- ATAN2 4 MB * UB ) 

ALPDG* ALPHA*RT D 
$INALP*SIN4 ALPHA) 

CQSALP*CQ$4 ALPHA) 

TANALP*TAN4 ALPHA) 

BET A* AS I N4 VB/V ) 

BETOG*BETA*RTD 

VXV Y*5QRT 4 VXRG*VXRG*VYRG*VYRG) 

GAMMA*ATAN24-VZR6,VXVY> 

GAMDG*GAMMA*RTD 
CO SO AM* COS( GAMMA) 

S INGA M*$ INI GAMMA) 

P5I£*ATAN24VYRG,VXIG) 

PS I EDO* PS I €*RTD 
S1NPS IE*$ IN ( PS IE ) 

COSPSIE*CO$ IPS I E)' 

VI*i./V 
VS* V* V 

VSOVS* VS/VSATS 

vxs*vx*vx 

VYS*VY*VY 

VZS*VZ*VZ 

VINERT*SQRT IVXS +VYS *VZS) 

C***** UPDATE THE ATMOSPHERIC VARIABLE'S. 

CALL ATMOS3 <HA*FTM* HAMAX * ANSW ) 

TAMB*518.67*ANSW( 2) 

RHO*ANSN 13 ) *.00237689 
CS*ANSWI4) *1116.45 
RMU*ANSW48> **373717E-6 
QB*.5*RHO*VS 
QS*QB*S 

FQBAR*28<.8/4QB*1Q.) 

R0QB=2. /( QB *10.) 

QS0*QS *OMA$ S I 

RN*RHO* V*RNREF / RMU 

MACH* V/CS 

HADOT*~VZRG 

XDOT* VX 

YDOT*VY 

ZDOT*VZ 

C***** GO TO SUBROUTINE OATAFUN AND CALCUATE AERO FUNCTIONS THAT 

C***** DEPEND ON MACH ANO ALPHA. 

IF I L 01 SI (37) ) 800* 801 

800 IF< INT-1 1801 *801* 802 

801 CALL DATAFUNI 1 > 

802 CONTINUE 
CCL*GCL*CL 
CCO=GCG*CD 

C***** IF LOGIC 1 IS TRUE* THE VISCOUS INTERACTION WILL 8E BY-PASSED 

I F ( LOG IC i 1 I ) GO TO 706 
I FI MACH.LT .4. ) GO TO 706 
HO* .24* TAMB +VS/5Q063. 

S HR* 1 7 700.* SORT I RHG i *< V*.QO0 1 1 **3.07 

701 SHRTWHO*SHR* I 1 . — •24*TW/H0) 

F*-TW * 1272 .992266*1 SHRTWHO**. 25 1 

FP*-i • -76. 37953596* SHR/ (HO* I SHRTWHO**. 75) I 
TWi*TW — F/FP 

I F ( ABS I TW1— TWI — 1 • ) 704*704*702 

702 TW*TW1 

GO TO 701 
704 TW*TW1 
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002012 


CPR-SQRT4 TW/TAMB J *4 TAMB + 198* 72 1/ 4TW+19B.72) 

002024 


VBAR=MACH*SQRT 4CPR/RNI 

002031 


I F 4 VB Aft—* 007 >706*707*707 

002033 

706 

CLV*CDV=CHV=0. 

002036 


GO TO 709 

002037 

707 

VBARQI=VBAR/.Q07 

002041 


CAF*CCD*COSALP -CCL*S IN ALP 

002045 


DCAF* £ VBARO !**• 636 -l.I*CAF 

002053 


CtV*~DCAF*$ INALP 

002055 


CD V* DCAF*COSALP 

002057 


CM V-0C A F*.l 1 58 3825 

002061 

709 

CCL i = CCL +CLV 

002063 


CC01=CCD +CDV 

002065 

710 

CONTINUE 


GUIDANCE SCHEME THE CODE FROM HERE TO CONTROL SYSTEM TEN 

C***** XS USED TO GENERATE COMMANDED ALPHA AND PHI. 

002065 


IF 4LDI SI 4 33 H 3 13, 309 

002067 

313 

IF4 INT- 1)314, 3 14 « 510 

002072 

314 

IF 4 AMQOIT * m 0025 * GU I ODT 1 -• 005 1.3.09 1 309. 5 10 

002100 

309 

XLFAC-QSG*SQRT (CCL1*CCL1 +CCDi*CCOl + 4 GC Y8*CYB*SET0GI**2) 

002111 


XL0D=CCL1/CCD1 

002113 


I F 4 XLOD-. 5 1 300 ,301 • 301 

0021 15 

300 

XL0D**5 

00211 7 

301 

XLODS*XLOD*XLOD 

002121 


DRAG*XLFAC/ SORT 1 1 . ♦XLOD.S ) 

002126 


IF 4 V- 15000. 1303,307,302 

002130 

302 

IF 1 V-22000, 1 307 , 307 , 304 

002133 

303 

HS* 19777. 7 +.48148*7 

002136 


GO TO 305 

002137 

304 

HS*62750. “1 •625* V 

002142 

305 

I F 4 HS-20500 . 13 06 , 308 , 308 

002145 

306 

HS=20500. 

002147 


GO TO 308 

002147 

307 

HS-27000. 

002151 

308 

CONTINUE 


targeting 

002151 


XYZE4 1 1=REH*CO$LON*COSGCL 

002154 


XYZE42 1*REH*SI NLON*COSGCL 

002156 


XY ZE 4 3 1«R€H*S I NGC L 

002160 


CALL HULT3 1 4 REC ,XYZE, RG1 

002162 


RG43)=RG43)+RTE 

002164 


RGP«n=RG(i) + DBAR 

002166 


RGP 42 I*RG42 4 -S IGN4 RTURN , RG4 2) ) 

002172 


RGP43 1*RG4 31 

002174 


DT s S0RT4 AMAX14 0* , 4RGPU )*RGP 4 1 ) +RGP 42 J*RGP 4 21 -RTURN*RTURN1) 1 

002206 


DTH»AT AN2 4RTURN, DT ) 

002211 


DVHEAD=ATAN24-RGP42I ,-RGP4 1 1 1-SI GN4 DTH, RG42 )) 

002223 


U* ABS 4 DVHEAO I 

002225 


IF 4 RGP 4 1)1 312, 3 12, 310 

002226 

310 

I F 4 AB S 4 RG4 2 M -R T URN ) 3 11 , 3 12 , 3 1 2 

002232 

311 

U*TP I -U 

002234 

312 

CONTINUE 

002234 


arc*rturn*u 

002236 


RGP 4 1 J*-DT*COS 4 DVHEAO) 

002242 


RGP 42 *»-OT*S INI DVHEA04 

002246 


RG431«RGI3>-RTE 

002250 


DO 315 0*1,3 

002252 

315 

TARE4J1*RG4JI -RGPU) 

002256 


CALL UNVEC4 RG, UXY ZE I 

002260 


CALL UNVECITAREtUTAREl 

002262 


CTH*DOT IUXYZE , UT ARE! 

002265 


TRANGE*ATK*ACOSICTH)+ARC*CNMFS 

002272 


DO 316 J*l, 3 

002274 

316 

TAI J)*-RGP(J» 

002277 


CALL MULT31 4REC1, TA, TA ) 

002302 


CIGAR 41,11 *-$I NGCL*COSLON 

002304 


C I GAR 4 1 *2 1 *- S I NGCL* SI NLON 

002306 


CIGAR! 1,3)= COSGCL 

002310 


CIGAR 4 2,11 SI NLON 

002311 


CIGAR4 2,2) x COSLON 

002312 


Cl GAR 42,3 i*0. 
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002313 


C I GAR I 3 , 1 )=-CO$GCL *COSLON 

002314 


CIGAR! 3,2)=-CQSGCL*SINLON 

002315 


CIGAR!3,3)*-SINGeL 

002316 


CALL MULT31 !CI GAR* TA* TAP) 

002321 


00 322 J=i,2 

002323 


IF! ABS!TAP!J) )-i. £-10)321,321, 322 

002327 

321 

TAP ( J )=SIGN! l.E- iO,TAP! J) ) 

002333 

322 

CONTINUE 

002335 


PSIET=ATAN2!TAP!2).TAP!1) 1 

002340 


DELAZ=PSIE -PSIET 

002342 


IF! PS I E*PSIET 1 325*325*328 

002343 

325 

IF1ABSIPSIE)-HPI)328,328,326 

002347 

326 

DELAZ=DELAZ -TPI 

002351 


IF(PSIEI327,328,328 

002353 

327 

DELAZ=DELAZ *2.*TPI 

002356 

328 

CONTINUE 

002356 


IF! I START- 1)330* 331* 330 

002360 

330 

RK2ROL=-SIGNQ • * OELAZ) 

002364 

331 

1ST ART* 1 

002365 


IFIYB -•0890117918)345.335*335 

002370 

335 

YB=— • 1 30899693 9 *.0001Q9Q830783*V 

002373 


I FI Y8 -•3054326191) 336*339,337 

002376 

336 

IF! YB -.0872664626)338,339,339 

002401 

337 

YB*. 3054326191 

002403 


GO TO 339 

002403 

338 

YB*. 0872664626 

002405 

339 

CONTINUE 

002405 


LMN=ALMN2*XL0D 

002407 


IF! ABS ! DEL AZ) - < YB-.03)) 341 , 341, 340 

002414 

340 

LMN*ALMN1*XL0D 

002416 

341 

IF! V-3500.) 342*345,345 

002421 

342 

LHN*. 93969* XLQD 


C ***** CONTROLLER GAIN SELECTION 

002423 

345 

Cl 7= .00678 -.00 0264* DR AG 

002426 


IF I OR AG-40. ) 35 1 , 351 , 350 

002431 

350 

C 16= • 065 

002433 


GO TO 360 

002433 

351 

I F ( DRAG-20. 1353, 353 * 3 5 2 

002436 

352 

C16=. 105 —.00 1*0 RAG 

002441 


GO TO 360 

002442 

353 

IF (DRAG-7. 5) 355, 355,354 

002445 

354 

C16=. 1794 -.00472*0RAG 

002450 


GO TO 360 

002451 

355 

C16=.35 -.02 7466 7*DRAG 

002454 


C 17=. 0 14 -• 001 22667*0RAG 

002457 

360 

IF! C17-. 003) 361,362,362 

002462 

361 

C 17=. 003 

002464 

362 

CONTINUE 

002464 


IF! V- 13600. ) 90 1,901, 900 

002467 

900 

C4=C5=0* 

002471 


GO TO 910 

002472 

901 

I F ! V- 1 3 100. ) 903 , 903 , 902 

002475 

902 

C4=— 1768. 

002477 


C5=. 13 

002500 


GO TO 910 

002501 

903 

I F! V-6845. ) 905 , 905,904 

002504 

904 

C4=-65. 

002506 


C5=0* 

002507 


GO TO 910 

002507 

905 

I F ! V-6 3 75. ) 907 ,907 , 906 

002512 

906 

C4=— 546.25 

002514 


C5=.07 

002515 


GO TO 910 

0025 16 

907 

l F ! V- 5 800. ) 9 09 , 909 , 908 

002521 

908 

C4=— 100. 

002523 


C5=0. 

002524 


GO TO 910 

002524 

909 

C4=83.l 

002526 


C 5=-. 03261 

002527 

910 

CONTINUE 

002527 


T 1 = (VI NERT* V I NER T / VS AT $ - 1 . ) *GS 

002533 


T2=CNHFS*1 VS -VQ*VQ)/(2.*!TRANGE-RPT) i 

002541 


IF! ISTRT)365,366,365 
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002542 

002552 

002556 

002560 

002562 

002567 

002573 

002573 

002574 

002577 

002605 

002607 

002617 

002621 

002622 

002625 

002631 

002635 

002635 
002636 
002641 
002645 
00265 L 
002653 
002660 
002661 
002663 
002664 
002666 
002667 
002671 
002673 
002675 
002700 
002703 
002706 
002714 
002716 
002720 
002723 
002725 
002734 
002736 
002760 
002741 
002746 
002762 
002765 
002767 
002772 


003014 

003014 

003020 

003030 

003040 

003050 

003052 

003055 

003057 

003062 

003063 

003075 

003102 

003111 

003114 

003116 

003120 

003122 

003124 

003126 

003127 

003127 


365 GO T0< 370*380, 390, 40Q1ISLECT 

366 IF(XLFAC-(GSTART*GS) 1367,370,370 

C***** CONSTANT ATTITUDE PHASE 

367 L0D1*AB$UMNI 

LOISQt 109J=L0IS0I6L ) = .T. 

LDIS0(621=L0ISQ(63 1=LD ISQ4641-LD l SO (651=. F, 

LD|S0<46 l=LOI$0447 1=LDIS0(48 1*.F. 

GO TO 410 

C***** CONSTANT HEAT RATE PHASE 

370 I STRT»1 

IF 4 V-20500. 1380# 382,382 

371 DREFP=C2i *C22*V *C23*VS 
IF ( DREFP-T 21 372 v 372,390 

372 ROTREF=-HS* ( 2.*C21*VI *C22i +C4 *C5*V 
ALDREF=— T i/DREFP 

ISLECT=l 

LD l SOI 46 )=LOl S0( 62 i*.T. 

LD I SO < 6 1 } = L D I S 0 ( 63 l-LDI SO C 64 1 = LD ISO 4 65 1= . F . 
tOISm 1091*10150447 )=LDIS0448 1*.F. 

GO TO 405 

C***** EQUILIBRIUM GLIDE RANGING PHASE 

380 ISLECT=2 

L0IS0447 7*L0I SOt 63 l 3 .T. 

LO I SO 4 6 1 1 *LD IS 0 1 62 1 =101 50 4 6 41 -LD I $0 4 65 1 = . F * 

ID I SO 4 1091 -LDI SO { 46 1=LDIS0<48 1=.F. 

I F4V-90Q0. 1400,381,381 

381 I F ( DREFP— 4 T2-2 • 1 1382,382,450 

382 I STP= l 

383 BA=BA1*0TR 

I F ( I FT 1385,384,385 

384 BA=60.*DTR 
BA 1=60. 

385 VBB=V 

IF 4 V-205G0. 1421, 421 , 420 

420 V8B*20500. 

421 CQSBA-COS ( BA1 

T EMP* 1 . 4* V S AT S * CO S B A/ GS 

IF 4 ( ALFM*TEMP 1- VSATS) 422 ,423 , 423 

422 VCG-SQRT 4 VSATS- 4 ALFM*TEMP 11 
IF 4 VCG-VQ) 423, 425,425 

423 VCG—VQ 

425 I F ( V-20500 . 1 43 5,426 • 426 

426 VBBS- VBB*VBB 

023*-GS*< VBBS/VSAT S -l. )✓ (C0SBA*i.41 

AK*— '3 • 5*023 /VBB 

C23*-AK/11000. 

C22=-520G0.*C23 

C21*D23 -C22*VBB -C 23* VBBS 

TT 1 1=— •5/C23*ALOG4 4 C21 +C22*V8B +C23*V BBS 1 / 4 C2 1 *C22*V ♦C23*VSM 
SQ—4. *C23*C21 -C22*C22 
IF ( SQ 1 430,429, 429 

429 SQQ*SQRT 4 SQ 1 

TT22*C22/4C23*SQQ)*4 ATANi 4 2»*C23*VBB^C22 1/SQQl -AT AN 4 4 2 • * C 23* V ♦ 
1C221/SQQ) 1 
GO TO 435 

430 SQQ*SQRTI-SQ1 

El 3 12* *C23*V8B +C22 -SQQ) /i 2. *C23*VBB *C 22 +SQQ) 

E2*42.*C23*V *C22 -SQQ) / 42.*C23*V + C22 +SQQI 
T T22* < C 22/ 4 C 23* 2 . *S QQ 1 1 * ALOG 4 E 1/ €2 1 

435 VBBS=VB8*VBB 

RFF* 4 TT M+TT22 1 *CNMF S 
I F 4 VCG-V 1 436 , 436 , 450 

436 IF 4 V-20500. 1437,438,438 

437 RFF=0. 

438 REQ=.5*TEHP *CNMFS*ALOGi ( VCG*VCG -V SATS) /( VBBS -VSATSli 
RCG*CNHFS*4 VCG* VCG -VQ*VQ1 / 42.*ALFM) 

GO TO 4440,445,4501 ISTP 

440 Rll=»REQ *RCG +RFF 
DBB 3 — 5. 

I F< BAX-35. 1442 , 442 , 441 

441 DBB 3 5 • 

442 8A2 3 BA1-DBB 
BA*8A2*DTR 

I STP*2 
GO TO 421 

445 R12=REQ ♦RCG + RFF 
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003132 

003141 

003143 

003144 

003145 

003150 

003152 

003152 

003154 

003155 

003156 

003156 

003161 

003167 

003171 

003204 

003205 

003207 

003221 

003223 

003226 

003227 

003232 

003236 

003242 

003244 

003246 

003254 

003255 

003257 

003262 

003263 

003266 

003272 

003274 

003275 

003303 

003303 
003304 
003305 
003312 
003317 
003320 
003323 
003327 
003333 
003340 
003343 
003345 
003351 
003357 
003365 
003367 
003370 
003372 
0033 72 
003374 
003403 
003405 
003407 
003416 
003420 
003422 
003423 
003426 
003430 
00343 1 
003436 
003440 
003452 
003453 
003455 


8AO*BAl+({ TRANGE-Rll— RPT ) / ( I R11-R12 )/( BAI-8A2 J I J 
IF4 BAD) 446*449* 447 

446 BA D*0* 

GO TO 449 

447 IF C BAD- 85* 1449*449*448 

448 BA0=85* 

449 CONTINUE 
BAl*8AD 
IFT=l 
ISTP=3 

GO TO 383 

450 f OREF* i VSOVS - 1* 1 *GS 

CGSBADO*! «4*CQS ( BAD*DTR > 

OR E FP *-TDR E F/C 0 S B ADO 

RDTREF*— 2**H5*DREFP*VI -2.*HS*GS*V/<COSBAOO*VSATS) *C4 >C5*V 
VOID* V 

R DT 01 D* ROT REF 

ALDREF*— Tl/DREFP *2.*HS*GS/ ( COS8ADO*V$ATS ) +2.*HS*DREFP/VS 
IF ( V- 20500* 1 45 7*457* 37 1 
457 IF ( 0REFP-T2J405* 390* 390 
C***** CONSTANT ORAG PHASE 

390 I SLECT*3 

101 SOI 48 )*LDISO (64 ) = *T* 

LDI SO ( 61) *LDI SOI 62 )*LDI SOI 63 1*101 SO I 65 )**F. 

10 1 SO ( 1 09 ) *LO I SO {46 )*LDIS0I47 1**F. 

IF (V-900Q. 1400*391*391 

391 0REFP*T2 

RDTREF*— 2 **HS*DR£FP*VI +C4 *C5*V 
IF 1 1 0FG2) 392 *392 *393 

392 V l 010* VOL D -500* 

RDC*.O02*IROTREF -RDTOLO) 

IDFG2* 1 

393 IFIV-VIOCOI 395*395* 394 

394 RDTREF*RDTREF -RDC*IV -V10LD1 

395 V0LD2* V 

ROT OL 2 * ROT R E F 

A1 OREF *-T 1 / T 2 * 2 * ♦HS*DRE F P/ VS 
GO TO 405 

C***** TRANSITION PHASE 

400 ISLECT*4 

LDI SQI65)*. T# 

LDI SOI 61 ) *LDI $01 62) *101 $0(631*101 SOI 64 l*.F. 

LDI SOI 109 ) *LDI SOI 46 |=LD I SOI 47 )*L Dt SOI 48 )* • F. 

VTR*l 

E£F*GS*HA *.5*VS 

460 I F { OREF P- I DF+. 01 ) >396*3 98* 3 98 

396 IFI0REFP-10F-*01H398»398»397 

397 0REFP*0F *S IGNI .01*0REFP-DF) 

398 IF ( OREF P -.01)399*401*401 

399 0REFP**0i 

401 Cl 1*1 DREFP -OF ) / ( EEF -EEF4) 

R ER 1=-CNMF S /C 11* A10G ( DF / DRE FP J 
GO TO! 465*4 70) 1 TR 

465 R1 1*R£R l 
1 TR*2 

DREFP*DREFP*i. 

GO TO 460 

470 R12*RER1 

DREFP*DREFP- I ( TR ANGE-Ri i-RPT II / ( R 1 1-R 1.2 J I -1 • 

IF I OREFP-. 01 >466*467*467 

466 OREFP*. 01 

467 0LIH=2.2*GS/SQRTU. +XLQOS) 

IF (OREF P-Dl I M 1 4 72 *4 72 , 47 1 

471 DREFP=01IM 
Cl 1*0. 

472 IFIV-7600. 1473*475*475 

473 C 16=2 • *C16 
C 17=0* 9*C 17 

475 CAGI*1*/1 VS +2 • *GS*H$) 

VC=VS* V 

ROTREF*!— HS* (2. *DREFP*V -Cil*VC) +C4*VS *C5*VC)*CAGI 
IF { I0FG31 476*4 76 *477 

476 V20LD*V0L02 -500* 

RDC* I RDTREF -R0T0L2 ) *.002 
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003460 

003461 

003464 

003470 


003515 

003521 

003525 

003536 

003541 

003544 

003550 

003553 

003556 

003557 

003563 

003566 

003567 

003571 

003574 

003577 

003603 

003605 

003607 

003607 

003612 

003615 

003616 

003621 

003625 

003630 

003633 

003641 

003641 

003644 

003646 


003650 
003652 
003653 
003656 
003661 
003664 
003667 
003671 
003673 
003675 
003675 
003700 
003702 
003704 
003706 
003706 
00371 L 
003713 
003715 
003717 
003721 
003723 
003725 

0 03727 
003731 
003732 
003733 
003736 
003742 
003743 
003746 


IDFG3* 1 

477 IFI V-V20LD)479,479,478 

478 RDTREF*RDTREF -RDC*( V-V2OL0 I 

479 ALDREF*GS*< i •- VSOVS l/OREFP +2.*V*RDTREF*CAG H2**RDTREF*R0TREF*GS* 
1CAGI/0REFP +2.*DREFP*HS*CAGI*2.*GS*RDTREF*HS*VI*CAGf +RDTREF*VI 

2 *GS*RDTREF*RDTREF/t DREFP*VS ) 

C***** CONTROLLER 

405 HD$ER~V*REH*REH*SINGCL*CO$GCL 

ROTREF^ROTREF “1 •5389E-17*H0SER*C0$GAM*CQSPS IE 
LOO 1*ALDREF *C 16*1 DRAG-OREFP) -C 17* (HADOT-RDTREF I 
IFI ABS I LGDLI-XL0DJ410, 410,407 
407 L0D1=SIGN( XLOO,LODl ) 

C***** LATERAL LOGIC 

410 IFI A8SI LODI J-LMN ) 413,4 11 , 41 1 

411 IF C0ELAZ*RK2R0LI 412,412,413 

412 LODl s S IGNILMN, LODI ) 

GO TO 480 

413 IFI ABS IDELAZ) -YB) 480,415,415 

415 IF(D£LAZ*RK2R0L)480,48Q,416 

416 RK2R0L*-RK2R0L 

C***** ROLL COMMAND AND ANGLE OF ATTACK COMMAND 

480 ARG*LGD1/XLGD 

I FI ABS < ARGi-1* 1482,481,481 

481 ARG=$IGNU.,LOOU 

482 R0LLC*AK2R0L*AC0SIARG) 

IFI V- 13600. 1484,484, 483 

483 ALPCM0»34.25 
GO TO 492 

484 I F< V— 9000* 1 486 , 486,485 

485 ALPCM0* 16.836 +.00128*V 
GO TO 492 

486 IF! V— 8000* 1 487,490,490 

487 I FI ABSIROLLC >-1.221 73)489,489, 488 

488 ROLLC*S IGNI 1*22 1 73, RGLLC ) 

489 IF CV-5000* 1 491, 491,490 

490 ALPCM0*4* 35 16 *.004G563*V -1.543E-7*VS 
GO TO 492 

491 ALPCMD=5.385 +.0Q3Q77*V 

492 ALPHAO*ALPCMD 
PHICM=RTD*ROLLC 

C***** CONTROL SYSTEM TEN AERODYNAMIC AND RCS 

C***** RCS AERODYNAMIC INTERFERENCE FUNCTIONS 

510 QBL*QB 
MACHL*MACH 

CALL FL IMIT I QBL , 0* ,20* I 
CALL FLIMITI MACHL,2«, 30* ) 
l F ( QB— 20* 1511,511,512 

511 CALL PUNCH TAB2 A , TABTAB2 ,QBL I 
TAB2=T ABTAB2I 1 ) 

CALL FUNC I ( TABS A , T ABTABl ,Q8L I 
IAB5*TA8TA81li i 
GO TO 513 

512 CALL FUNCHTAB22A,TABTAB3,MACHL) 

TAB2»TABTAB3li) 

CALL PUNCH TAB55 A, TABTAB3 ,MACHL ) 

TA85=TABTAB3Il ) 

513 CONTINUE 

CALL PUNCH TAB l A, T AST AB1 , QBL ) 

TABl=TABTA81< l ) 

CALL FUNC 1(TAB4A,T ABTABl ,QBL ) 

TAB4=TABTAB1(1> 

C ALL FUNCH TAB6 A, T ABTABl ,QBL ) 

T AB6*T ABTAB HI) 

CALL FUNC1 1 TAB 8 A, T A8TAB2 , QBL ) 

TAB8-TABTAB2I 1) 

C***** DELSB FUNCTION 

IF! VR- 10000.) 671, 670,670 

670 DEL SB=»0* 

GO TO 681 

671 IF C VR-8GQ0. )673,673»672 

672 DELSB=85. fr.0425* 1 8000 .-VR) 

GO TO 681 

673 IFI VR-450G. >675,674,674 

674 DEL SB = 85. 
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003750 

003750 

003753 

003757 

003760 

003762 

003762 

003765 


003770 
003771 
003774 
003776 
003776 
004000 
004002 
004006 
004010 
004014 
J 040 16 
004021 
004024 
004024 
004027 
004030 
004033 

004033 

004036 

004041 

004043 

O04043 

004045 

004045 

004051 

004051 

004053 

004056 

004057 

004060 

004063 

004064 

004066 

004076 

004076 

004100 

004101 

004103 

004104 

004107 

004112 

004116 

004121 

004123 

004124 

004127 

004134 

004136 

004137 

004137 

004142 

004144 

004146 

004150 

004153 

004155 

004156 

004157 

004160 

004162 

004164 

004165 


GO TO 681 

675 I F ( VR— 4000. 1677*677*676 

676 DELSB=55. *0. 06* ( VR-4000. I 
GO TO 681 

677 DELSB=55. 

681 CONTINUE 

C***** DELE CONTROL — - ACTIVE WHEN QB GE 2 

DELE=. 5*1 DEL ER ♦DELED 
DEL A=. 5*( DELEL -DELER) 

C***** G0 jo SUBROUTINE DATAFUN AND CALCULATE AERO FUNCTIONS THAT 

C***** DEPEND ON CONTROL DEFLECTIONS. 

IF I LOI S 11 37! 1 805 * 806 

805 IF( INT- 1) 806, 806 » 807 

806 CALL DATAFUN (21 

807 CONTINUE 
ERRPH1«PHICM-PHIDG 
ABPHI^ABSIERRPHI) 

FGV*RTD*GE*S IN PH I *COSTHE*VI 
RPRI=RDG-FGV 

BAT ADT-PDG*$ I N AL P -RPR l * COS AL P 
ERRALP*ALPHAC -ALPDG 
I F C AB S ( ERR AL P i -2 . ) 52 9 * 52 9* 5 2 8 

528 ERRALP=SIGN(2. , ERRALP) 

529 CONTINUE 

IF { QB -2. I 526 # 52 7 » 52 7 

526 ERALI *0. 

OELET=OLEC=DELEIC 
GO TO 520 

C***** GKAL FUNCTION 

527 IF I VR- 12000. ) 52 1 • 522, 522 

52 1 I F IV R- 1 00 00 . I 5 23 , 52 3 , 524 

522 GKAL =2. 

GO TO 525 

523 GKAL*6. 

GO TO 525 

524 GKAL 25 6. ♦•002*1 1G00Q.-VR I 

525 CONTINUE 

ERR ALPO=GKAL*ERRALP 
IFIHACH -7. 1516.516,515 

515 SBTERM-O. 

GO TO 517 

516 SBTERM=.25*<85. -DEL SB) 

517 IF ( INTI 531, 530, 531 

530 DELET=0ELEIC ♦SBTERM 

531 OLEC=-ERRALPO -• 1 *ERAL 1 ♦6.*QDG -SBTERM ♦DELET 
520 CONTINUE 

C***** RCS SECTION CALCULATED ONCE PER INTEGRATION STEP. 

ROLNL-RGLN 
ROLPL*ROLP 
YAWNL-YAWN 
YA WPL 3 Y AWP 

IF I INT— 1) 540, 540* 580 

540 IF ( QB -10.) 541, 541. 601 

C***** RCS - — ROLL LOGIC 

541 ER1*I BETDG -.05*CONU2, 1 1 J*SINALP 
ER2-RPR I /TANAL P-PDG 
ERR0LL=*ER2-ER1 

ABB* ABS (ERR DLL ) 

I FI ABB— .051 601* 601,602 

601 LOI SOI 81) ^LQI SGI 82 1*LD I SOI 103 )*LDIS0( 104 )*.F. 

ROLN*ROLP=0. 

L ATRQL-0 
GO TO 613 

602 IF(AB8-. 2)603,609, 609 

603 IF( LATROLJ607, 601,608 

607 IF l ERROLL 1 605 , 6 05*60 1 

608 I F( ERROLL >601, 601 ,606 

609 l F I A8 8— l • ) 6 04 , 6 04 , 6 1 0 

604 I FI ERROLL i 605,605,606 

605 LATROL*-! 

LOI SO ( 103) =.T. 

LDISOI 104)=.?. 

LOI SOI 81) =L0 I S0( 82 ) =.F • 

R0LN*2. 

R0LP*0. 

GO TO 613 


TOO 
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00*165 

004166 

0041 n 

004171 

004172 

004174 

004175 

004175 

004177 

004200 

004203 

004205 

004206 

004207 

004207 

004210 

004213 

004215 

004216 

004217 

004222 

004225 

004227 

004231 

004233 

004234 

004235 

004237 

004240 

004240 

004243 

004245 

0042 47 
004251 
004253 
004254 
004255 
004256 
004257 
004260 
004260 
004261 
004262 
004263 
004264 

004265 

004270 

004273 

004276 

004300 

004301 

004305 

004306 

004310 


004310 
004313 
004314 
004315 
0043 1 7 
004322 
004324 
004327 
004331 
004335 
004340 
004341 
004342 
004346 
004352 
004354 
004356 


606 LATROL=l 

LDIS0( 81)=LD1S0< 82) =.F. 
ldisouo4i=.t. 

LDISOI 1031=. F. 

R0LP=2. 

R0LN=0. 

GO TO 613 

610 I F < ERRGLL >611,611,612 

611 LATROL — i 

LDI S0( 81 )=LD ISO( 103 )=• T. 

LDI$0(82)*LDIS0C104>=.F. 

R0LN=4. 

ROLP=0. 

GO TO 613 

612 LATR0L=1 

LDISO ( 82)=LDIS0( 104 J*.T. 

LDI $01 81) *LD I SO I 103 )=.F. 

R0LP=4* 

R0LN=0. 

C ***** RCS PITCH LOGIC 

613 IFiGB -20.1614,614,615 

614 £P1=Q0G -.05*C0NU2,2> 

PITERR=ERRALP -EP1 
ABB=ABS(PITERR) 

1F( ABB— .2)615, 615,616 

615 LOI SOI 105)=.F. 

LD I SO 1 1 06.1 * • F • 

PITN=PITP=0. 

LATPI T=0 

GO TO 622 

616 IFIA88-. 251617,619,619 

617 IF I LA T PIT 1618,615,6175 

618 IFIPITERR1620, 620,615 
6175 IF (PI TERR) 615 ,615,621 

619 IF ( PI TERR1620, 620,621 

620 LATPI T=— l 

LD I SO 1 1 05 ) = • T • 

LDISOl 106)=.F. 

PI TN=2 • 

PITP*0. 

GO TO 622 

621 LATPI T*1 
LDISOI 105)- .F. 

LD I SOI 1 06) = . T . 

PITP=2. 

PITN=0. 

C***** RC S — —YAW LOGIC 

622 IF4ALPDG -18.) 623,623,624 

623 IF (MACH— 5. ) 625 , 625,624 

625 IF < ALPDG-10. 1626, 542, 542 

626 ERRYAW=ABYAW=0. 

GO TO 629 

C***** YAW LOGIC - — ALPHA LE 18 AND GE 10, MACH LE 54EY6 EONS). 

542 EY4*3 • 4*BAT ADT -4.*CGN1 1 2 , 61 
ERRYAW=EY4 

A 8 Y AW= A8S ( E RRY A W ) 

GO TO 820 

C***** YAW LOGIC ALPHA GT 18 OR MACH GT 5IEYA EUNS). 

624 IF4A8PHI -3. ) 640, 640, 641 

640 ERPHLM=0. 

GO TO 642 

641 ERPHLM=A8PHI -3. 

IF( ERPHLM -10.1586,586,585 

585 ERPHLM=1Q. 

586 ERPHLM=SIGN( ERPHLM, ERRPHI I 

642 RLL=RPRI -C0NK2,3) 

EY2=2.*RPRI +FQBAR*RLL 
I F < QB -20.) 544,544,543 

543 8LL=0. 

GO TO 545 

544 BLL=COSALP*( BETDG - .05*C0N1 1 2, 4 ) ) 

545 ERRYAW=ERPHLM*S INALP -EY2 +BLL 
ABYAW=ABS(6RRYAW) 

IF(ABYAW-. 05)629, 629, 630 

629 LATYA W»0 
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004357 

004364 

004371 

004373 

004373 

004376 

004401 

004403 

004405 

004407 

004411 

004412 

004413 

004417 

004423 

004425 

004426 

004426 

004427 

004430 

004434 

004440 

004442 

004443 

004443 

004446 

004451 

004454 

004456 

004457 

004462 

004465 

004471 

004472 

004473 

004473 

004474 

004477 

004502 

004506 

004507 

004510 

004510 

004512 

004513 

004516 

004521 

00452 5 

004526 

004527 

004527 

004530 

004533 

004536 

004542 

004543 

004544 

004544 

004546 

004547 

004552 

004554 

004560 

004562 

004563 

004563 

004564 

004567 

004571 

004575 

004577 

004600 

004600 

004603 

004606 


LDISOIiQ7)=LDISOI108)*LDISGI83)=LDISGI 84)*.F. 

LDISOi85)=LDlSO(86l=LOISO(87)=LDISQ<88)=.F. 

YAWN=YAWP=0. 

GO TO 639 

630 IF I ABYAW-. 20)631*635 *63 5 

635 1FCA8YAW 51 632 *632 ,810 

631 IF < LA TY AW 1628* 629*6295 
628 IF (ERRYAWl 633* 633*629 

6295 IF I ERR YAW 1629* 629*634 

632 IF (ERR YAW 1633* 633*634 

633 LATYAW*-! 

LD1SOC 1071=# T. 

LOISOI 108 )=LDI SOI 83 J = LDI$0< 84 ) = .F. 
LDISOI85)=LDISO(86)=LDISQI87)=LDISai88)=.F. 
YAWN=1 • 

YAWP*0. 

GO TO 639 

634 LATYAW* 1 
LOISOI 1081=. Te 

LO I $Q U 07 ) =LO I SO 1 83 )=LO I SO 1 84 1 = . F . 

L 0 1 SO ( 8 5 1 =L 0 1 S 0 ( 86 1 * LD I SO ( 8 7 ) =LO I SO ( 8 8 1 = • F . 
YAWP-1. 

YAWN-0* 

GO TO 639 

810 IF < ABYAW -1 . > 636 ,636* 8 l i 

811 IF I QB-20. 1 636, 812,8 12 

812 1F< ABYAW -1.51813*813,816 

813 IF < ERRYAWl 8 14*8 14*815 

814 L AT Y A W=-l 

LOI SOI 107I*LDI SGI 851*. T. 

L01S0 I 86)=LDISQI 87 I=LDI SOI 88 ) = .F. 

LOI SOI 1081=101 SOI 83 1=LDI SOI 84)=*. F. 

YAWN=3. 

YAWP=0. 

GO TO 639 

815 LATVAW=1 

L 0 I SO I I 08 1 * L 0 1 SO I 86 1 = . T . 

LDIS04 1071=L0I SO I 83 )=LDI SGI 34 ) = «F. 

LOI SOI 85)=LDISQ( 87 1 =LD I SO ( 88 ) = «F. 

YAWP=3. 

Y AWN=0. 

GO TO 639 

816 IF! ERRYAWl 817* 817*818 

817 LATYAW*-! 

LDISOI 107)=LDIS0(87)=.T. 

LOI SOI 108 )*LDI SO I 831 = 101 SOI 841*. F. 

LOT SO 1 85) *L 01 SO I 861*10 1 SOI 83 1 = .F • 

YAWN* 4. 

YAWP*0. 

GO TO 639 

818 LATYAW*! 

to I SO 1 1 08 1 =L 0150188) =. T . 

LOISOI 1071*101 SO ( 83 )*L0 ISO! 84 )=.F. 

LO I SO I 851 *LD I SO ( 86 ) *LD I SO 1 87 1 = .F . 

YAWP*4. 

YAWN*0. 

GO TO 639 

636 IF I ERR YAW 163 7* 63 7*638 

637 LATYAW*-! 

LOI SOI 83) *101 $01 107 )*• T • 

LOISOI 84)=LDIS0I 108)*.F. 

LOISOI 85) *LOI SOI 861*101 SOI 871 *101 SOI 88 )*.F. 
YAWN* 2 • 

YAWP=0. 

GO TO 639 

638 LATYA W=i 

LOISOI 83)=LDIS04 107 )=.F. 

LOISOI 84) *LOISOI 1081=. T. 

LOI SOI 85) =L 01 SOI 861 = LOI SOI 87)*L01S0I88) = .F. 
YAWP*2. 

YAWN*0. 

GO TO 639 

820 IF I ABYAW 5)629,629. 821 

821 IFIABYAW -1. 1631 * 822,822 

822 IFIABYAW-l. 5)632, 632.823 


102 
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004611 

004614 

004617 

004617 

004620 

004624 

004630 

004631 

004635 

004641 

004645 

004653 

004653 

004657 

004665 

004665 

004670 

004672 

004672 

004674 

004700 

004703 

004706 

004706 

004715 

004731 

004737 

004742 

004745 

004750 

004752 

004755 

004760 

004762 

004771 

004771 

004774 

004777 

005002 

005005 

005007 

005007 

005012 

005012 

005020 

005023 

005024 

005026 

005030 

005030 

005033 

005035 

005035 

005041 

005046 

005051 

005053 

005056 

005062 

005062 

005064 

005066 

005071 

005071 

005077 

005102 

005103 

005104 

005113 

005115 

005117 


823 IFIABYAM -2.1636*636.824 

824 IF ( ABY AM-2* 51813 « 813*816 
639 CONTINUE 

UP-DONN COUNTER 
NU0CTR*0 

I F 1 YAWN-YAWNL- .11831*831* 830. 

830 NU0CTR*YAWN-YAWNI>.1 
GO TO 833 

831 I F I Y A WP-Y AWPL- • 83 3 * 833 » 832 

832 NUOCTR*YAWPL-YA«P-.i 

833 IF( ROLN— RGLNL-. 1 1 835*835*834 

834 NUOCTR*NUDCTR+ROLNL-ROLN-.l 
GO TO 860 

835 IF! ROL P-ROL PL-. 1 1 860*860*836 

836 NUDCTR~NUDCTR+ROLP-RQLPL*.l 

860 CONTINUE 

IFiVR -10000.1861*861*862 

861 GNUD*. 1 
GO TO 863 

862 GNUD=R0Q8 

863 DELANUO-DELANUD *GNUD*NUDCTR 
IFLABS ( DELANUD 1 -5.1865*865.864 

864 OELANUO*SIGN( 5 • * DELANUD 1 

865 CONTINUE 

EMX*8250.*( 4RQLP — R0LN1 *T AB1 +CYAWP -YAWNI *TAB21 

EMY*2 8267. 5* ( P ITP*TAB3 -PITN*T AB4 * I YAWP +YAWN 1*T AB5 MRQLP +R0LN1 
1*TA86 1 

EMZ*28675.5*( ( YAWP —YAWNI *T A87 MRQLP -ROLN) *T AB81 
TX*TY*T2*0. 

575 TROLN~TROLN +RQLN*H 

trqlp*trolp +rolp*h 

TPITN*TP1TN +PITN*H 
TPITP*TPITP +PJTP*H 
TYAWN=TYAWN +YAWN*H 
TYAWP*TYAWP +YAWP *H 

FUELU5E®TISPH* 4 T ROLN +TRGLP +TPITN *TPiTP +TYAWN +TYAWPI 
580 CONTINUE 

I F ( G B -2.1665*550*550 

550 IF4ALP0G -18.1551*551*657 

551 IF 1 MACH-5. 1658,658*657 

OELA CONTROL ALPDG LE 18 AND MACH LE 5 

658 IF I AB PH 1-2 0 • 16585*65 85 *65 86 

6585 ERRPHI 2-ERRPHI 
GO TO 6587 

6586 ERRPHi2=SlGN(20. » ERR PH 1 1 

6587 CONTINUE 

EA2=.25*ERRPHI2 -PDG*COSALP -RPRI*S INALP 

DEL AC2-EA2 *.i*EA2I 

DELACi^O. 

C***** D£LR CONTROL ALPHA LT 18 AND MACH LT 5 

IFIVR -2000.1554*554.555 

554 GKR=2. 

GO TO 556 

555 IFIVR -2500.1519,518,518 

518 GKR*4. 

GO TO 556 

519 GKR=2. +.004MVR -2000.1 

556 EY5=GKR*(3.4*BATADT -4. ♦CON 1 C 2* 6 1 1 
DELRC=~EY5 -.Q5*EY5I 

DI F=DELRC -OELR 

IFIABSCOIFI -RATLIMR ) 891 . 891 * 890 

890 OELRC^OELR +SI GN ( RATLI MR . DIF 1 

891 CONTINUE 
ABB=ABSiOELRCI 

IF (ABB-22.8 16576, 6576* 6575 

6575 DEL RC = SIGN <22.8* DELRC 1 

6576 CONTINUE 

HMR*QB*733i .*< CHR*DELR *CHB*BETDGI 
I F( ABS ( HMR 1 -9.9E5I883.882.882 

882 DRMX*0. 

GO TO 881 

883 0RMX=21.*SQRT( 1. -HMR/9.9E5I 
I F < DRMX -10.1881*881,880 

880 0RMX=10. 

881 RL1MIT0UI*— DRMX 
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005121 


RLIMITD42)= OR MX 

005122 


GO TO 659 


£***** 

DELA CONTROL ALPDG GT 18 OR MACH 

005122 

657 

IF4QB -20.1561,561,560 

005125 

560 

EOELA 1*0. 

005126 


GO TO 562 

005127 

561 

EDELAl=BETDG - .05*CQNi 42, 5 1 

005132 

562 

CONTINUE 

005132 


EDELA2*RPRI/TANALP -POG -EDELA1*S INALP 

005137 


ABEDA2 3 =ABS< E0ELA2 1 

005141 


IF4ABEOA2-. 051643,643, 644 

005143 

643 

ERMP*0. 

005144 


LATDLA*0 

005145 


GO TO 648 

005145 

644 

IF 4 ABEDA2-. 21 645,646, 646 

005150 

645 

IF < LATOLA 1 6455 , 643 ,6456 

005152 

6455 

IF (E0ELAZ1 647, 647,643 

005154 

6456 

I F I € DEL A2 1643,643, 6475 

005156 

646 

IF 4 EDELA2I 647, 647,6475 

005160 

647 

LATDL A— — 1 

005161 


GO TO 6485 

005162 

6475 

LATDLA-1 

005163 

6485 

ERMP=EDELA2 

005165 

648 

CONTINUE 

005165 


IF4QB -10.1566,566,565 

005170 

565 

IF4QB -30.1568,567,567 

005173 

566 

GKDA*10. 

005175 


GO TO 569 

005175 

567 

GK0A=2 • 5 

005177 


GO TO 569 

005177 

568 

GKOA-1 0. -4QB-1Q. )*$LPAQ 

005203 

569 

CONTINUE 

005203 

687 

DELACi=GKDA*ERMP +DELANUD 

005206 


DELAC2*0. 

005207 

659 

DELAC=DELAC1 + DELAC2 

005211 


CALL LIMIT 4 OLE C ,-35 .,20.1 

005214 


IFIOELE -5.1870,871,871 

005217 

870 

IF! DELE +20.1872,872,873 

005222 

871 

AB0A=20. -DELE 

005224 


GO TO 874 

005225 

872 

ABDA-35. +OELE 

005227 


GO TO 874 

005230 

873 

ABDA=15. 

005232 

874 

CONTINUE 

005232 

664 

I F ( ABS( DELAC 1 -ABDAi 665,665, 666 

005236 

666 

DELAC=SIGN4ABDA, DELAC 1 

005241 

665 

CONTINUE 

005241 


DLECL*DLEC +OELAC 

005243 


DIF-OLECL -DELEL 

005245 


IF4ABS4DIF1 -RATELI Ml 886 , 886, 885 

005250 

885 

DLECL*DELEL +S I GN 4 RAT EL I M, OIF 1 

005254 

886 

CONTINUE 

005254 


DLECR=*OLEC -DELAC 

005256 


0IF*DLECR -DELER 

005260 


IF 4 AB$ 4 01 F 1 -RATELI Ml 888, 888,887 

005263 

887 

DLECR* DELER +S I GN 4 R AT EL I M, D I F 1 

005267 

888 

CONTINUE 

005267 


CALL LIMIT! OLE CL ,-35., 20.1 

005272 


CALL LIMIT 4 OLE CR , -35 . , 20 . 1 

005275 


HMEC= 19047. *QB*GCHE 

005300 


HMER*HMEC*CHER 

005302 


HMEL=HMEC*CHEL 

005304 


I F ( A8 S 4 HME R 1 -1.1 7E6 1893, 892 , 892 

005307 

892 

DEHXR*0. 

005310 


GO TO 876 

005311 

893 

DEMXR*32.*SQRT41. -HMER/i . 17E61 

005320 


IF 4DEMXR -20.1 876,876, 875 

005322 

875 

0EMXR*20. 

005324 

876 

RL I M I TR 4 1 1 *-DE MXR 

005326 


RL IMITR 421= DEMXR 

005327 


IF 4 ABS 4 HMEL 1 - 1 . 1 7E6 1 896 , 895 , 895 

005332 

895 

DEMXL=0. 

005333 


GO TO 878 
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005334 

005343 

005345 

005347 

005351 

005352 

005355 

005356 

005360 

005362 

005371 

005400 

005407 

005414 

005420 

005424 

005433 

005442 

005450 

005465 

005474 

005504 

005507 

005512 

005515 

005522 

005530 

005536 

005546 

005556 

005562 

005564 

005366 

005570 

005572 

005622 

005646 

005676 

005704 

005711 

005717 

005723 

005730 

005734 

005743 

005752 

005761 

005764 
005770 
0057 72 
005775 
005777 
006004 


696 DEMXL®32.*SQRTU. -HMEL/ 1 • 17E61 
IHDEMXL -20.1878. 878*877 

877 DEMXL=20. 

878 RLIMITL(1J®-0EMXL 
RLIMITU2)* DEMXL 
THECDOT=VYRG*REH I/CGSGCL +OMEGA 
TEMP1®THECDGT*C0SGCL 

TEMP2®— VXRG*REHI 

TEMP3=-THECDQT*SINGCL 

BI GP® P— ELI* TEMP i-EL2*TEMP2-EL3*TE HP 3 

BIGQ=Q-EM1*TEMP1-EM2*TEMP2-EH3*TEMP3 

BIGR=R-EN1*TEMP1-EN2*TEMP2-EN3*T£MP3 

PH IDQT®BIGP*TANTHE* ( BIGQ*S INPHI +BIGR*CGSPHI 1 

THE DOT ®BIGQ*COSPHI— B1GR*S INPH I 

PS IOOTjc (fllGQ*S INPHl +BIGR*COSPHI ) /CO ST HE 

CCD=CCD1 +GCDE ♦CDE *GCOSB*CDSB +GCDBF*CDBF 

CCL=CCL 1 +GCLE ♦CLE +GCLSB*CLSB +GCLBF*CLBF 

AX®QSG* (CCL*S I NALP -CC0*C0SALP1 >TX*OMASSI 

AY®QSG*H GCY 8 *C Y 8 *-GCYBSB*CYBSB 1*BET DG +GCYDR*CYOR*DELR +GC YDA*CYQA 
1 ♦DE-LA I *TY*GMA SS I 

AZ*-QSQ*( CCL*COSALP +CCD*SINALP 1 *TZ*OMAS$ I 
ACCEL® SORT (AX* AX +AY*AY +AZ*AZ1*PTS 
FX®OMASS*AX -TX 
FY=OMASS*AY -TY 
FZ=OMA$S*AZ -TZ 
VXDRG*ELi*AX«*EMi*AY*ENl*AZ 
VYDRG=EL2*AX*EM2*AY+EN2*AZ 
V ZDRG®EL3*AX*EM3*AY+EN3*AZ 

VXDOT®— VXDRG*S I NGCL*CO$LONI -VYORG*$lNLONl -VZDRG*CD$GCL*COSLQNI 
1+GXI 

VYOOT=-VXDRG*SlNGCL*SINLQNl ♦VYDRG*COSLONI -VZDRG*CQSGCL*S INLQN i 
1+GYI 

VZDOT® VXDRG*C OSGCL -VZORG*S INGCL +GZI 

BT V*HSPAN*V I 

CTV'H CHORD* VI 

QS SPAN® OS* SPAN 

GSCHORD®QS*CHORD 

L=Q$SPAN*IBTV*<GCLP*CLP*P+GCLR*CLR*R> + BETOG* C GCLB*CLB +GCL BSfi* 
1CLBSBI *GCL DA* CL DA*DEL A ♦GCLDR*CLDR*OELR 1 *EMX -< YQFF*FZ-ZOFF*F Y1 
M® OSCHORO* ( GCM*CM+CMV ♦CTV*GCMO*CMQ*Q *GCME*CME ♦GCMSB*CMSB*GCMBF* 
1CMBFI +EMY -(ZOFF*FX-XOFF*FZI 

N® OSS PAN* ( (GCNB*CN 8 +GCNBSB*CNBSBI*BETDG +BTV*I GCNP*CNP*P +GCNR* 
1CNR*R ) +GCN OR* C N0R*0 EL R +GCNDA*CN0A*DELA1 *EMZ -CXGFF*FY -YOFF*FX) 
ROT i=EX*P -£XY*Q -EXZ*R 
R0T2®— EXY*P +EY*Q -EYZ*R 
R0T3=-EXZ*P -EYZ*Q +EZ*R 
ROTL®L -Q*R0T3 +R*R0T2 
ROTM® M ~R*ROTi *P*R0T3 
ROTN®N -P*RGT2 +Q*R 0 T 1 

PDOT®OETl*{ TERMA*ROTL *TERM8*R0T M ♦TERMC*R0TN1 
OOOT®OETI*( T£RMB*ROTL ♦TERMD*ROTM +TERME *RQTN> 

ROOT * OET 1*4 TERMC*ROT L +TERME*ROTM frTERMF *ROTN 1 
IF C INT .GT • 1 1G0 TO 90005 

C***** STORE PAST VALUES FOR CONVOLUTION INTEGRATION. 

CONK 4* ll=CONl ( 4*41 =C0N1 (4* 5 ) =BATADT 

CONK 4* 2 )®QOOT *RTD 

CONI (4,6) ■*« AY-CONK 3 *61) *HI 

CON K 4, 31 * I RPR I -CON K 3 • 3 1 1 *H I 

CONK 3 9 1 1 =CONl ( 3 1 41® CONI (3. 51 = BETDG 

CONK 3 «2) S Q0G 


006005 

CONK 3 »31 ®RPRI 

006006 

C0N1(3»61=AY 

006007 

U1®PASTL 

006011 

U2*PASTR 

006012 

U3®PASTD 

006014 

PASTL=0LECL 

006015 

PASTR«DLECR 

006016 

PASTO®OELRC 

C***** RECORDER OUTPUT AND TABLE UPDATES 

006017 

DACI l )®HA*2.E-6 

006021 

DACI 21®V*2.E-5 

006023 

OACI 31®ACCEL*.2 

00602 5 

OACI 4)®( ALPDG *10. )*.Q2 

006030 

DACI 5 )®ERRALP*. 5 

006032 

DACI 6) ®C PHIDG *I00.1*.005 
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006035 DACI 7I=ERRPHI*.05 

006037 DAC! 8 l=TRANGE*.004 

006041 DAC! 9l*!0ELA*25. I*. 02 

006044 OAC ( 101*0ELE*. 025 

006046 OAC C 1 1) *OELR*. 05 

00604 7 DAC i 12 1 =PDG*. 125 

006051 0AC(13)*QDG 

006053 DAC! 14)®RDG*.l25 

006054 DACI 15)=BETDG*.25 

006056 DACI 161 *( GAMDG+20. 1 *.04 

006061 TABLE! 80)*T 

006063 TA8LE! 8i)*QB 

006064 TABLE! 82)*HA 

006066 TABLE! 83)=VR 

006067 TABLE (84)=GAMMAA 

006071 T ABLE ! 85) *PS I A 

C***** PUT A NEW DISPLAY GUT TO THE CONTROL CONSOLE DIGITAL DECIMAL 

C***+* DISPLAY AND TYPE OUT ANY CHANGES HADE TO VARIABLES. 

0060 72 I F 1 LO I S 1 1 22 1 1C ALL SCANNER 1J SCAN J 

006075 CALL D SPLAY 

006076 IEILD1SI!1711G0 TO 90050 

006100 I El VARCHNG1 CALL TYPEVAR 

006102 I F i ENABLE .AND. TYPESW 1 CALL TYPEVAR 

006105 ENABLE*. NOT. TYPESW 

006107 I F I AUTOTYP. AND . LDI S I ( 1411 CALL TYPEVAR 

006112 90050 CALL RTMODE 

006113 90001 CONTINUE 

006113 IF! T-CNGRATE 190061 « 90061* 90060 

006116 90060 IF(AHGO!T fr.0025 * 0FTEN1 -.005)90061 *90061,90005 

006124 90061 CALL RECORD 

006125 90005 CONTINUE 

006125 IF (LDI $ I (35 DC ALL RTPAUSEILOI SI! 40) *LOISO! 1 13) 9 L0I SI 144)1 

C***** INTEGRATE NON-LINEAR DIFFERENTIAL EQUATIONS. 

006131 CALL 1 GRATE l 

006132 IF! .NOT.LDISI 1 341 )G0 TO 90065 

006134 IF! iNT.GT.i) INT=1 

006137 90065 CONTINUE 

006137 I F I INT.GT.DGO TO 90006 

006143 IF ILOISQI 111)1 752* 750 

006144 750 IF I HA— 70000. 1751*751 »752 

006147 751 LDI SO! 1 11 I s . T. 

006150 CALL RECORD 

006151 752 IF I LDI SO! 112 1 1755*753 

006153 753 IF I V-1500. 1 754* 754* 755 

006156 754 LDI SOI 112 1*.T. 

006157 CALL RECORD 

006160 755 IF! LDI SO! 113 1 1 760*756 

006162 756 IFIHA) 757*757*760 

006164 757 LD I SOU 131 = . T. 

006165 760 CONTINUE 

C***** INTEGRATE LINEAR DIFFERENTIAL EQUATIONS (CONTROL SYSTEM TRANS- 

C***** F£R FUNCTI0NS1WITH C0NV01 AND MODLAG. 

006165 CALL CONVOi 

006166 CALL MOOLAG! PASTL* DELEL t 10. *RLIMITL*OL IMITE*U1*X11 

006175 CALL MODLAG! PASTR.DELER. 10. *RLIMITR,0L IN ITE* U2 *X2> 

006204 CALL MOOL AG IP A S T 0 * DELR .20. .RLIMITD »0L IMITR ,U3»X3 1 

006213 ELERL= ( DELEL -Xll*HI 

006216 ELERR* ! DELER -X2)*H1 

006221 RUDR = I DELR -X3)*Hl 

006224 X1=0ELEL 

006225 X2*DEL€R 

006226 X3=DELR 

006230 CALL RECYCLE 

006231 90014 CONTINUE 

C***** THIS IS THE CODE EXECUTED WHEN THE PRINT SWITCH IS DEPRESSED. 

006231 NRUN=NRUN U 

006233 WRITE ( MF* I INRUN 

006240 WRITE IMF* 41L0GIC1 1) .LOGIC! 2) .LOIS 1133 1 »LDI SI 4 34) * LDI SI (37) 

0062 56 WR I T£ ( MF , 2 M I NT EG I I I ) * 1 1 *3 .8 ) 

006270 WRITE (MF* 10 1 (TABLE! 1 1 )» 11 = 1 * 100) 

006302 WRITE ( MF* 3) 
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006306 

006310 

006334 

006360 

006404 

006430 

006454 

006476 

006520 

006542 

006543 

006543 

006544 

006544 

006545 

006555 

006565 

006575 

006605 

006615 

006625 

006631 

006634 

006644 

006654 

006664 

006670 

006671 


006671 

006672 

006673 

006674 

006674 

006674 

006674 


006674 

006674 

006674 

006674 

006674 

006674 


90030 CALL PLAYBAM90032SJ 

WRITE1MF,11) T,HA,RN, GCLATDG,RLONDG, V,M ACH, I SLECT 
WRITE! MF» 10 )DELANUO f HAOOT ,DRAG,HMER,HMEL ,HMR,OELEL • OELER 
WRITE!MF.13)NU0CTR,GAM0G,RPRI.ELERR,ELERL,RUDR,VBAR,VINERT 
WRITE ! MF, 10) ACCEL, QB,POG, QDG.RDG »THEDG, PS IDG, T RANGE 
WRITEiMF, 10 ) BET DG, ERRPHI ,PDOT,QDOT > ROOT » PI TERR , ERROLL, ERR YAW 
WRITE! MF» 10) AL PDG, PH IDG»0ELE, DELA, DELR, DELSB, DELBF 
WRITE IMF, 10)ALPHAC,PHICM,DL EC. OELAC » DELRC » P S I EOG, VR 
WRITE! MF, 12 )TROLN. TROLP.TPITN, TP ITP,TYAWN,T YAWP, FUEL USE 
GO TO 90030 
90032 CONTINUE 

CALL APRINT 
90015 CONTINUE 

C***** THIS IS THE CODE EXECUTEO WHEN THE READ SWITCH IS DEPRESSED. 

CALL RELEASE 

CALL R E ADOUT 1 6 , NOUT , T , H A , GCLATOG, RLONOG, V , RN ) 

CALL READOUT (6, NOUT , MACH, I SLECT, ACCEL , QB , PD G , ODG I 
CALL READOUT 1 6 , NOUT , ROG, THEDG, PS IDG , TR ANGE • BE TOG, GAMDG ) 

CALL READOUT 16 , NOUT , PDOT , QDOT , ROOT , PIT ERR, ERROLL, ERRYAW) 

CALL READOUT! 6, NOUT, ALPOG.PHIDG, DELE, DELA, DELR, DELSB) 

CALL READOUT 16, NOUT, DELBF, ALPHAC.PHICM.DLEC, DEL AC, DELRC I 
CALL READOUT 13 , NOUT ,NUDCT R, PSIEDG, VR) 

CALL READOUT (l, NOUT, FUELUSE I 

CALL READ0UTI6, NOUT, TROLN.TROLP.TPITN, TP ITP.T YAWN, TYAWP) 

CALL READOUT 16, NOUT ,D£LANUD,RPRI ,DELEL , OELER, VBAR, VINERT) 

CALL READOUT (6 , NOUT, HMER * HMEL *HMR, RUOR, ELERL, ELERR ) 

CALL READOUT !3 ,NOUT ,DRAG,HADOT .ERRPHI ) 

CALL AREAO 
90004 CONTINUE 

C***** THIS IS THE CODE EXECUTED WHEN THE TERMINATE SWITCH IS DE- 
CS**** PRESSED. 

CALL ATERM 
90017 CALL SYNCH 
CALL RTMODE 

1 FORMAT !/2X,*RUN NUMBER *, I3//2X, *THESE ARE THE VALUES IN TABLES FQ 
1R THIS RUN. * ) 

4 FORMAT i 201 2X,L 31 i 

2 FORMAT 120(2X,I3) i 

3 FORMAT 1 //2X , IHT , 15X.2HHA, 14X ,2HRN, 14X, 7HGCLATDG, 9X .6HRLONOG, 10X , 

2 1H V , 1 5X ,4HMACH, 12X, 6H I SLECT / 

1 2X , 7H0ELANUD ,9X , 5HH ADOT , 1 IX ,4HDRAG,12X .4HHMER, 12X, 4HHMEL, 12X.3HHMR 
2 , 13X, 5HDELEL, 1 IX, 5HDELER/ 

12X,6HNUDCTR,10X, 5HGAMDG, 1 IX,4HRPRI , 12X, 5HELERR • l IX , 5HELERL , IIX , 
24HRUDR , 12X, 4HVBAR, 12X, 6HV INERT / 

12X, 5H ACCEL , 11X,2HQB, 14X.3HPDG, 13X, 3HQDG, 13X.3HR0G, 13X, 5HTHEDG, l IX, 
2 5 HP S IDG, 11X , 6HT RANGE/ 

12 X, 5HBETDG, 1 IX ,6H ERRPHI , 10X, 4HPD0T , 12X, 4Hu00T , 12X, 4HR00T, 12X, 
26HPITERR, 10X,6H ERROLL, 10X,6HERRYAW/ 

12X, 5HALPDG, 1 IX , 5HPHIDG, l IX, 4HDELE, 12X, 4H0ELA, 12X, 4H0ELR, 12X, 

25HDEL SB,l IX ,5HDELBF/ 

12X , 6HALPHAC , 10X, 5HPH ICM, l IX , 4HDLEC, 12X, 5HDELAC , 1 l X , 5HDELRC , l 1 X , 
26HPSIEDG,1QX»2HVR/ 

12X, 5HTRCB.N, 1 IX , 5HTR0LP ,11X,5HTPITN,1 IX, 5HTPITP , 11X, 5HTYAWN ,11 X , 
25HTYAWP,11X, 7H FUELUSE/ I 

10 FORMAT !8!2X,£14.7)i 

11 FORMAT! 7!2X,E14.7),2X,I14) 

12 FORMAT !7!2X,E14.7)/) 

13 FORMAT 12X, 1 14, 7! 2X, E14. 7) > 

90034 FORMAT! IX,* JOB, 43, 28800, 75000, 1024. C1202 15319T 100857 L.F.ROW 

IELL ROOM 2124 PROGRAM ARFDS*) 

END 
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CROSS REFERENCE MAP-ARFDS 

PROGRAM LENGTH INCLUDING I/O BUFFERS 
011321 

statement function references 

LOCATION GEN TAG SYM TAG REFERENCES 
STATEMENT NUMBER REFERENCES 


LOCATION GEN TAG SYM TAG REFERENCES 


007235 

C 0033 7 

1 

006232 

007251 

C 00353 

2 

006256 

007254 

C00356 

3 

006302 

007246 

C 00350 

4 

006240 

007422 

C00524 

10 

006270 

007425 

000527 

11 

006310 

007431 

C00533 

12 

006520 

007434 

C00536 

13 

006360 

000752 

L 00356 

53 

000750 

000760 

L 00363 

54 

000751 

000767 

LOO 367 

55 

000757 

001271 

L 00535 

60 

NONE , 

001275 

L00536 

61 

001267 

001301 

L 00537 

62 

NONE 

001305 

L 00540 

63 

001277 

001311 

L00541 

64 

NONE 

001315 

L 00542 

65 

001307 

002115 

L 01 022 

300 

NONE 

002117 

L 01 023 

301 

002114 

002130 

LO 1027 

302 

NONE 

002133 

L01030 

303 

002127 

002137 

L 01032 

304 

002132 

002142 

L01033 

3 05 

002136 

002145 

L 01 034 

306 

NONE 

002147 

LO 1036 

307 

002127 

002151 

L 01 037 

308 

002143 

002100 

L 01 016 

309 

002066 

002226 

LO 1061 

310 

NONE 

002232 

L 01 062 

311 

NONE 

002234 

L01063 

312 

002225 

002067 

L01014 

313 

002065 

002072 

L 01 01 5 

314 

002070 

002252 

L 01074 

315 

002255 

002274 

L 01 11 1 

316 

002276 

002327 

L 01 134 

32 L 

002325 

002333 

L 01 135 

322 

.002326 

002343 

LO 1143 

325 

002342 

002347 

L 01144 

326 

NONE 

002353 

LO 1146 

327 

NONE 

002356 

LO 1 147 

328 

002342 

002360 

L 01150 

330 

NONE 

002364 

tOl 151 

331 

002357 

002370 

1011 53 

335 

002366 

002376 

LO 1 155 

336 

NONE 

002401 

L01156 

337 

002375 

002403 

L 01 160 

338 

002400 

002405 

L01161 

339 

002374 

002414 

t 01 163 

340 

NONE 

002416 

tO 1 164 

341 

002412 

002421 

tOl 165 

342 

NONE 

002423 

t 01166 

345 

002367 

002431 

L01170 

350 

NONE 

002433 

t 01172 

351 

002427 

002436 

t 01 173 

352 

NONE 

002442 

L01175 

353 

002434 

002445 

t 01 176 

354 

NONE 

002451 

LOi 200 

355 

002443 

002457 

L01202 

360 

002432 

002462 

t01203 

361 

NONE 

002464 

L01204 

362 

002460 

002542 

1 01234 

365 

NONE 

002552 

L01237 

366 

002541 

002556 

t 01240 

367 

NONE 


006334 006404 006430 006454 


001270 

001300 

001310 


002131 002132 
002144 002146 
002077 

002230 002231 


002345 002346 002351 002352 


002377 002400 002402 

002413 

002417 002420 

002430 

002435 . 

002444 

002441 002450 

002461 


006476 
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002573 L01245 

002577 L01247 

002607 101251 

002635 L01260 

002653 101265 

002660 101266 

002661 L01267 

002664 L0 127 1 

002667 101273 

003226 L 01404 

003244 L014U 

003255 L 01414 

003263 t 01417 

003266 LO 1420 

003272 L 01421 

003327 L 01434 

003333 L 01435 

003340 L 01436 

003343 L01437 

003303 L 0142 5 

003345 101440 

003515 L 01477 

003541 L01503 

003544 1 01504 

003550 tO 1505 

003553 t 01 506 

003557 L 01510 

003563 LO 1511 

003566 L01512 

002673 LO 1275 

002675 101276 

002 706 tO 1302 

002716 tO 1305 

002720 L 01306 

002723 101307 

002767 L 01321 

003014 101327 

003050 101335 

003057 L01340 

003062 101341 

003063 101342 

003111 L 01347 

003120 101352 

003122 101353 

003127 101357 

003143 101362 

003145 101364 

003150 101365 

003152 101366 

003156 101372 

003223 101403 

003323 101433 

003365 101445 

003405 101454 

003407 101455 

003372 101451 

003420 101460 

003423 L 01462 

003426 101463 

003431 101465 

003453 101471 

003461 L01474 

003464 L01475 

003470 101476 

003567 101513 

003574 101515 

003577 101516 

003605 101521 

003607 101523 

003612 101524 

003616 101526 

003621 101527 

003625 101530 

003630 101531 

003633 L 01532 


370 

002546 

371 

003222 

372 

002606 

380 

002547 

381 

002652 

382 

002575 

383 

003155 

384 

NONE 

385 

002663 

390 

002550 

391 

003243 

392 

003254 

393 

003254 

394 

NONE 

395 

003264 

396 

NONE 

397 

NONE 

398 

003325 

399 

NONE 

400 

002551 

401 

003341 

405 

002634 

407 

NONE 

410 

002572 

411 

003546 

412 

003551 

413 

003547 

415 

003561 

416 

NONE 

420 

NONE 

421 

002672 

422 

NONE 

423 

002704 

425 

002715 

426 

002721 

429 

002765 

430 

002766 

435 

002722 

436 

003056 

437 

NONE 

438 

003060 

440 

003106 

441 

NONE 

442 

003117 

445 

003107 

446 

NONE 

447 

003142 

448 

NONE 

449 

003141 

450 

002657 

457 

003222 

460 

003371 

465 

003363 

466 

NONE 

467 

003403 

470 

003364 

471 

NONE 

472 

003417 

473 

NONE 

475 

003424 

476 

003452 

477 

003452 

47 8 

NONE 

479 

003462 

480 

003556 

481 

003573 

482 

003573 

483 

NONE 

484 

003604 

485 

NONE 

486 

003610 

487 

NONE 

488 

NONE 

489 

003623 

490 

003617 


002554 002555 

002576 

002576 002656 

002606 003224 

003265 

003326 003331 

002652 003243 

003342 

003225 003302 

003537 003540 

003552 

003126 

002705 

003013 

003061 

003144 003146 

003056 003110 

003404 

003425 

003463 

003562 003564 

003611 

003624 

003620 


003332 


003147 


003565 
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003641 

101534 

491 

003631 

003632 





003644 

101535 

492 

003606 

003615 

003640 




003650 

101537 

510 

002071 

002077 





003664 

L01546 

511 

003662 






003675 

L01 555 

512 

003663 






003706 

tO 1563 

513 

003674 






004056 

101647 

515 

NONE 






004060 

L01651 

516 

004054 

004055 





004063 

L01652 

517 

004057 






005033 

102210 

518 

005031 






005035 

102212 

519 

005032 






004076 

101655 

520 

004032 






004036 

101637 

521 

NONE 






004041 

101640 

522 

004034 

004035 





004043 

101642 

523 

004037 

004040 





004045 

101644 

524 

004040 






004051 

101645 

525 

004042 

004044 





004027 

101633 

526 

NONE 






004033 

101636 

527 

004025 

004026 





004021 

101631 

528 

NONE 






004024 

101632 

529 

004017 

004020 





004064 

101653 

530 

NONE 






004066 

101654 

531 

004063 






004107 

101662 

540 

004105 






004112 

101663 

541 

004110 






004301 

101773 

542 

004274 

004275 





004340 

102011 

543 

NONE 






004342 

102013 

544 

004336 

004337 





004346 

102014 

545 

004341 






004774 

102173 

550 

004772 






004777 

102174 

551 

004775 






005026 

102205 

554 

005025 






005030 

102207 

555 

005025 






005041 

102213 

556 

005027 

005034 





005125 

102237 

560 

NONE 






005127 

102241 

561 

005123 

005124 





005 132 

102242 

562 

005126 






005170 

102262 

565 

NONE 






005173 

102263 

566 

005166 

005167 





005175 

102265 

567 

005171 

005172 





005177 

102267 

568 

005172 






005203 

102270 

569 

005174 

005176 





004742 

102163 

575 

NONE 






004771 

102172 

580 

004106 






004322 

102004 

585 

NONE 






004324 

102005 

586 

004320 

004321 





004127 

101670 

601 

004111 

004125 

004142 

004145 

004146 

004147 

004137 

101674 

602 

004126 






004142 

101675 

603 

NONE 






004153 

101701 

60V 

004151 






004155 

101702 

605 

004144 

004145 

004153 




004165 

101711 

606 

004147 

004154 





004144 

101676 

607 

NONE 






004146 

101677 

608 

004143 






004150 

101700 

609 

004140 

004141 





004175 

101720 

610 

004152 






004177 

101721 

6 1 i 

004175 






004207 

101727 

612 

004176 






004217 

L01734 

613 

004136 

004164 

004174 

004206 



004222 

101735 

614 

004220 






004233 

101741 

615 

004221 

004232 

004243 

004246 

004247 

004250 

004240 

101746 

616 

004232 






004243 

L01747 

617 

NONE 






004245 

101750 

618 

NONE 






004251 

L01752 

619 

004241 

004242 





004253 

101753 

620 

004245 

004246 

004251 




004260 

101761 

621 

004250 

0042 52 





004265 

101766 

622 

004237 

004257 





004270 

101767 

623 

004266 






004310 

101777 

624 

004267 

004272 





004273 

101770 

625 

004271 






004276 

101771 

626 

NONE 






004403 

102 027 

628 

NONE 






004356 

102017 

629 

004300 

004355 

004401 

004404 

004405 

004406 




004601 

004602 
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004373 

L02024 

630 

004355 






004401 

t 02 026 

631 

004375 

004605 





004407 

L 02 031 

632 

004377 

004400 

004607 

004610 



004411 

102032 

633 

004403 

004404 

004407 




004426 

102041 

634 

004406 

0044 10 





004376 

102025 

635 

004374 






004544 

102111 

636 

004444 

004445 

004450 

004612 

004613 


004546 

102112 

637 

004544 






004563 

102121 

638 

004545 






004617 

102135 

639 

004372 

004425 

004442 

004472 

004507 

004526 




004543 

004562 

004577 




004313 

102000 

640 

004311 






004315 

102002 

641 

004312 






004327 

102006 

642 

004314 






005 143 

102245 

643 

005142 

005150 

005153 

005154 

005155 


005145 

102250 

644 

005142 






005150 

102251 

645 

NONE 






005156 

102254 

646 

005146 

005147 





005160 

102255 

647 

005152 

005153 

005156 




005165 

102261 

648 

005144 






005122 

102236 

657 

004776 

005001 





005002 

102175 

658 

005000 






005207 

102272 

659 

005121 






005232 

102304 

664 

005224 

005227 





005241 

102306 

665 

004773 

005234 

005235 




005236 

102305 

666 

NONE 






003731 

101600 

670 

003730 






003733 

101602 

671 

003730 






003736 

101603 

672 

NONE 






003743 

101605 

673 

003734 

003735 





003746 

101606 

674 

003744 






003750 

101610 

675 

003745 






003753 

101611 

676 

NONE 






003760 

101613 

677 

003751 

003752 





003762 

101614 

681 

003732 

003742 

003747 

003757 



005203 

102270 

687 

005174 

005176 





001755 

100761 

701 

002007 






002006 

100770 

702 

NONE 






002010 

100772 

704 

002004 

002005 





002033 

101000 

706 

001734 

001736 





002037 

101902 

707 

002032 






002061 

101011 

709 

002036 






002065 

101013 

710 

NONE 






006144 

102522 

750 

NONE 






006147 

102523 

751 

006145 






006151 

102526 

752 

006143 

006146 





006153 

102527 

753 

NONE 






006156 

L02530 

754 

006154 






006160 

102533 

755 

006151 

006152 

006155 




006162 

102534 

756 

NONE 






006164 

102535 

757 

006162 






006 165 

102536 

760 

006160 

006161 

006163 




001722 

100745 

800 

001721 






001725 

100746 

801 

001721 

001723 





001727 

100750 

802 

001724 






003771 

101617 

805 

003770 






003774 

101620 

806 

003770 

003772 





003776 

101622 

807 

003773 






004443 

102050 

810 

004400 






004446 

102051 

811 

NONE 






004451 

102052 

812 

004447 






004454 

102053 

813 

004452 

004615 

004616 




004456 

102054 

814 

004454 






004473 

102063 

815 

004455 






004510 

102072 

816 

. 004453 

004616 





004512 

102073 

817 

004510 






004527 

102102 

818 

004511 






004600 

102130 

820 

004307 






004603 

102131 

821 

NONE 






004606 

102132 

822 

004604 






004611 

L 02 133 

823 

NONE 






004614 

LQ2134 

824 

NONE 






004624 

L 02137 

830 

NONE 






004631 

102 141 

831 

004622 

004623 
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004635 

L 02 142 

832 

NONE 

004641 

102143 

833 

004630 

004645 

102144 

834 

NONE 

004653 

102146 

835 

004643 

004657 

102147 

836 

NONE 

004665 

102150 

860 

004652 

004670 

102151 

861 

004666 

004672 

102153 

862 

004667 

004674 

102154 

863 

004671 

004703 

102156 

864 

NONE 

004706 

102157 

865 

004701 

005217 

102276 

870 

NONE 

005222 

102277 

871 

005215 

005225 

102301 

872 

005220 

005230 

102303 

873 

005221 

005232 

102304 

874 

005224 

005322 

102333 

875 

NONE 

005324 

102334 

876 

005310 

005345 

102344 

877 

NONE 

005347 

102345 

878 

005333 

005115 

102232 

880 

NONE 

005117 

102233 

881 

005103 

005102 

102225 

882 

005100 

005104 

102227 

883 

005101 

005250 

10231 i 

885 

NONE 

005254 

102312 

886 

005247 

005263 

102315 

887 

NONE 

005267 

102316 

888 

005262 

005056 

102217 

890 

NONE 

005062 

102220 

891 

005054 

005307 

102326 

892 

005306 

005311 

102330 

893 

005306 

005332 

102337 

895 

005331 

005334 

102341 

896 

005331 

002467 

L0 1205 

900 

NONE 

002472 

101207 

901 

002465 

002475 

101210 

902 

NONE 

002501 

101213 

903 

002473 

002504 

101214 

904 

NONE 

002507 

101217 

905 

002502 

002512 

101220 

906 

NONE 

002516 

101223 

907 

002510 

002 521 

101224 

908 

NONE 

002524 

101227 

909 

002517 

002527 

101231 

910 

002471 

004247 

101751 

6175 

004244 

004405 

102030 

6295 

004402 

005152 

102252 

6455 

NONE 

005154 

102253 

6456 

005151 

005162 

102257 

6475 

005155 

005163 

102260 

6485 

005161 

005066 

102222 

6575 

NONE 

005071 

102223 

6576 

005065 

005005 

102176 

6585 

005003 

005007 

102200 

6586 

005004 

005012 

102201 

6587 

005006 

006113 

102504 

90001 

000056 

001260 

100531 

90002 

000022 

000566 

100265 

90003 

000060 

006671 

L 02670 

90004 

0.00661 

006125 

102507 

90005 

005762 

001260 

100531 

90006 

000022 

000212 

L00074 

90007 

000214 

000216 

100101 

90008 

NONE 

006231 

L 02555 

90014 

000062 

006544 

102635 

90015 

000063 

006672 

102671 

90017 

000054 

006306 

L 02601 

90030 

006542 

006543 

102634 

90032 

006306 

007440 

C 00542 

90034 

000024 

006112 

102503 

90050 

006077 

006 116 

102505 

90060 

NONE 

006124 

102506 

90061 

006114 

006137 

102516 

90065 

006133 


004633 004634 

004644 

004655 004656 

004702 

005216 

005221 

005227 

005321 

005344 

005114 


005055 

002466 

002474 

002503 

002511 

002520 

002500 002506 002515 002523 

005157 t 

000057 006141 

006123 

000057 006141 

0061 10 

006115 006123 

006135 
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BLOCK NAMES AhIO LENGTHS 

REALTIM- 000656 INTCOMH- 000043 INTINTR- 000U3 CCONAl - 000076 

TABLES - 000156 DRIVER - 000007 FUNCNAM- 000043 

VARIABLE REFERENCES 


LOCATION 

GEN TAG 

SYM TAG 

REFERENCES 





010561 

VOiOO? 

ABB 

004123 

004137 

004150 

004230 

004240 

005063 

010613 

V01043 

ABDA 

005223 

005226 

005231 

005233 

005236 


010610 

V01040 

ABE0A2 

005140 

005145 





010544 

V00772 

ABPHI 

004001 

004310 

004315 

005002 



010563 

voiou 

ABYAM 

004276 

004307 

004353 

004373 

004376 

004443 




004451 

004600 

004603 

004606 

004611 

004614 

010073 

V00132 

ACCEL 

000077 

005503 

006022 

006407 

006557 


OOOOOOCOl 

A00001 

AOC 

000026 

000042 





010472 

V00720 

AK 

002735 






010463 

VOOT11 

AL0REF 

002620 

003220 

003302 

003514 

003530 


010047 

V00076 

ALFM 

002702 

002706 

003075 




010046 

V00075 

ALMN1 

002414 






010055 

V00104 

ALNN2 

002405 






010534 

V00762 

At PC MO 

003606 

003614 

003640 

003643 

003644 


000000006 

V00152 

ALPOG 

000126 

001571 

004014 

004265 

004273 

004774 




006024 

006457 

006606 




000027C05 

V 00304 

ALPDGIC 

000454 

001015 





010257 

V00467 

ALPHA 

001016 

001575 

001041 

001043 

001567 

001571 

001573 

010113 

V00161 

ALPHAC 

000136 

003645 

004013 

006501 

006616 


010023 

A00047 

ANSW 

001657 






010443 

V00671 

ARC 

002235 

002267 





010532 

V 00760 

ARG 

003570 

003576 

003577 




010041 

V 00070 

ATK 

002266 






000265C01 

VQ0061 

AUTOTYP 

006106 






010626 

VG1071 

AX 

005447 

005474 

005504 

005522 

005530 


010627 

V01072 

AY 

005464 

005474 

005507 

005516 

005523 

005531 




005771 

006005 





010630 

V 0 1076 

A2 

005473 

005475 

005512 

005517 

005525 

005533 

010464 

V00712 

BA 

002662 

002665 

002675 

003125 

004070 

005452 

010510 

V00736 

8A0 

003140 

003143 

003145 

003151 

003152 

003161 

010546 

VO 0774 

BATAOT 

004013 

004301 

0050*1 

005763 



010205 

V 00400 

BA1 

000606 

003153 

002661 

002666 

003115 

003122 

003132 

010506 

VQ0734 

BA2 

003123 

003132 





010260 

V 00470 

BETA 

001020 

001045 

001047 

001603 



010103 

V00I42 

8ET0G 

OQOlll 

001605 

002101 

004112 

004342 

005073 




005127 

005453 

005606 

005661 

005777 

006054 




006433 

006571 





000030C05 

V00305 

BETDGIC 

000455 

001017 





010623 

V01055 

BIGP 

005370 

005411 





010624 

VO 1056 

BIGQ 

005377 

005406 

005414 




010625 

V01057 

8 1 GR 

005406 

005415 





010570 

V01016 

BLL 

004340 

004345 

004350 




010637 

VOillO 

BTV 

005563 

005606 

005662 




010323 

V 00541 

B 1 1 

001210 

001212 

001223 

001244 



010325 

V00543 

B13 

001225 






010330 

V00547 

BIT 

001241 

001247 





010331 

V00550 

B18 

001245 






010324 

V 00542 

B3 

001214 

001226 





010427 

VO 0654 

CAF 

002044 

002051 

005564 




010526 

V00754 

CAGI 

003435 

003450 

003477 

003507 



010413 

V 0063 7 

CCD 

001732 

002041 

002063 

005432 

005442 

005466 

010432 

V00657 

CC01 

002064 

002103 

002111 

005423 



010412 

V 00635 

CCL 

001730 

002042 

002061 

005441 

005465 


010431 

V00656 

CCL1 

002062 

002102 

002110 

005432 



000001C07 

V 00640 

CD 

001731 






000036C07 

V01065 

CDBF 

005430 






000012C07 

VO 1063 

CDE 

005424 






000020C07 

VO 1064 

CDSB 

005426 






010424 

V00651 

COV 

000316 

001604 

001617 

002022 

002034 

002056 




002063 

005276 

005445 




000027C07 

V01034 

CHB 

005072 






00G042C07 

V 0 1 046 

CHEL 

005302 






000041C07 

V01045 

CHER 

005300 






OOOOOOCQ5 

V00252 

CHORD 

000412 

005570 





000026C 07 

VO 1033 

CHR 

005071 






007754 

A00036 

CIGAR 

002303 

002316 
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00000QC07 

V00636 

CL 

001727 






000005C07 

V01116 

CLB 

005575 






000035C07 

V01070 

CLBF 

005437 






000024CQ7 

VO 1 117 

CLBS8 

005577 






000015C07 

VO 1 120 

CLOA 

005611 






000007C07 

VO 1121 

CLOR 

005613 






000011C07 

VO 1066 

CLE 

005433 






00GQ34C07 

V01114 

CLP 

005601 






000032C07 

V01115 

CLR 

005603 






00001 7C07 

VO 1067 

CLSB 

005435 






010423 

V00650 

CL V 

002035 

002054 

002061 




000002C07 

V01122 

CN 

005626 






O0OO37C07 

VO 1126 

CMBF 

005640 






000013C07 

VO 1124 

CHE 

005634 






000030C07 

VO 1 123 

CMQ 

005631 






000021C07 

V01125 

CMSB 

005636 






010425 

V 00652 

CMV 

002033 

002060 

005627 




000004C07 

VO 1127 

CNB 

005657 






00002 3C 07 

V 01130 

CNBSB 

005660 






00Q016C 07 

VO 1 134 

CNDA 

005667 






000010C07 

VO 1133 

CNDR 

005664 






00001 7C 05 

V00317 

CN GRATE 

000471 

006113 





010040 

V 0 0 06 7 

CNMFS 

002270 

00253 7 

003053 

003072 

003100 

003354 

000033C07 

VO 1131 

CNP 

005651 






000031 C07 

VO 1132 

CNR 

005653 






000002C04 

A00007 

CONI 

NONE 






010266 

V00476 

COSALP 

001045 

001211 

001221 

001242 

001575 

002041 




002055 

004011 

004344 

005014 

005443 

005465 

010465 

V00713 

COSBA 

002677 

002724 





010512 

V00740 

CGSBAOO 

003166 

003206 





010270 

V 00500 

COS BET 

001051 

001207 

001222 

001237 



010272 

V 00502 

COSGAM 

001055 

001120 

001622 

003522 



010300 

V00510 

COSGCL 

001071 

001112 

001124 

001135 

001143 

001153 




001415 

001452 

001471 

002152 

002306 

003517 




005352 

005542 

005552 




010165 

V00243 

C05GCLT 

000266 

0002 77 

000306 




010353 

V 00573 

COSLQN 

001435 

002151 

002302 




010304 

V 00514 

COS L ONI 

001107 

001112 

001131 

001141 

001424 

001447 




001456 

005536 

005550 




010162 

V00240 

COSLONT 
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V00743 

ViOLD 

003256 

003263 

003266 




010530 

V00756 

V20LD 

003454 

003461 

003464 




010371 

V 00611 

MB 

001550 

001552 

001564 




00 0 004 C 05 

V00260 

WEIGHT 

000423 

000666 





00Q043C 05 

V00272 

MXRG 

000442 

001155 

001521 




000044C05 

V00273 

MYRG 

000441 

001157 

001523 




000 045 C 05 

V00274 

WZRG 

000440 

001161 

001525 




000 02 7C 02 

V00516 

X 

001113 

001342 

001370 

001416 



000030C02 

VO 0632 

XDOT 

001262 

001715 





010433 

V 00660 

XL FAC 

002110 

002124 

002553 




010434 

VO 0662 

XLOD 

002112 

002116 

002117 

002405 

002414 

002421 




003032 

003536 

003541 

003567 



010435 

V00663 

XLODS 

002120 

003407 





000013C05 

VO 0267 

XOFF 

000434 

-005623 

005645 




007751 

A00035 

XYZE 

002153 

002160 





0 10262 

V00472 

XI 

001033 

006172 

006213 

006224 



010263 

V00473 

X2 

001034 

006201 

006216 

006225 



010264 

VO 0474 

X3 

001036 

006210 

006221 

006227 



00003 1C 02 

VO 051 7 

V 

001115 

001342 

001372 

001415 



010224 

VO 0421 

YAWN 

000653 

004101 

004372 

004424 

004442 

004471 




004507 

004525 

004543 

004561 

004577 

004620 




004624 

004706 

004717 

004755 



010555 

V01003 

YAWNL 

004102 

004620 

004624 




010225 

VO 042 2 

YAWP 

000652 

004102 

004371 

004425 

004441 

004472 




004506 

004526 

004542 

004562 

004576 

004631 




004635 

004706 

004716 

004732 

00476 0 


010556 

VO 1004 

YAWPL 

004103 

004631 

004635 




010207 

V00402 

YB 

000611 

002365 

002372 

002376 

002402 

002404 




002407 

003560 





000032C02 

V00633 

YDOT 

001716 






000OL4C05 

V00271 

YOFF 

000435 

005571 

005646 




000033C 02 

V 00520 

Z 

001117 

001340 

001401 




010333 

V00552 

ZB 

001254 

001255 





000034C02 

V00634 

ZOQT 

001720 

005075 





000015C05 

V00270 

ZOFF 

000433 

005572 

005622 




010344 

V 00 564 

ZOREHS 

001356 

001374 

002101 




010337 

V 00557 

ZS 

001341 

001343 

001354 




010332 

V00551 

ZT 

001251 

001254 






START OF CONSTANTS 
006676 

START OF TEMPORARIES 
007453 

START OF INDIRECTS 
007575 

UNUSED COMPILER SPACE 
005600 
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SUBROUTINE LIMIT ( VARI , VHI N,VMAX) 


000006 


IF(VARI-VMINJ2,4,1 

000010 

l 

IF ( VARI— VMAX14 ,4, 3 

000013 

2 

V ARI*VMIN 

000014 


GO TO 4 

000015 

3 

VAR I* VMAX 

000016 

4 

RETURN 

000017 


END 


* 

000002 


000002 
000004 
000006 
0000 1 2 
000022 
000025 
000031 
000035 
000040 
000041 


SUBROUTINE PQl 

COMMON/ CCQNAl/Ht NEQlvCONl C 10« IT 
C *** CONIC l,N)*NTERMll 
C *** CONIC 2*N)=X 
C *** CONU 3.NI*U 
C *** CONIC 4,NI*U0 
C *** CONIC 5*NI*UOO 
C *** CONIC 6,N1*M 
C *** CONIC 7,NI*P 
C *** CONIC 8*N)»Qi 
C *** CONIC 9»NI*Q2 
C *** CONIC 10, NI=Q3 
HH5*H*H*.5 
00 10 N=I,NEQ1 
Z~1«/CGN1C6,N) 

CONIC 7,Ni*EXPC-C0NiC6,N)*Hl 
CONK 8,Nl*Cl„-C0NlCT,Nn*Z 
CONU 9,N1*C H-CONi 1 8*N) 1 *Z 
CONIC 10,NJ»CHH5-C0Nl(9 f N) **Z 
10 CONTINUE 
RETURN 
END 
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CONVOl 

STORAGE ALLOCATION. 


AODRESS 

LENGTH 


BINARY 

0 

24 


IOENT 

24 



END 



BLOCKS 

TYPE 



PROGRAM* 

LOCAL 



CCONAl 

COMMON 


ENTRY POINTS. 
CGNVOl 


COMPASS - VER 2. 08/25/76 07.24. 5i. 

CONTROL CAROS. 

CONVOl 

ADDRESS LENGTH 

0 24 

0 14 


EXTERNAL SYMBOLS. 


GOTOER. 






IDENT 

ENTRY 

EXT 

USE 

0 



H 

8SS 

l 



NEQ 

BSS 

2 



NTERM 

BSS 

3 



X 

BSS 

4 



U 

BSS 

5 



UD 

BSS 

6 



UDD 

BSS 

7 



Vi 

BSS 

10 



P 

BSS 

11 



Ql 

BSS 

12 



Q2 

BSS 

13 



Q3 

BSS 





USE 

0 

03171626173455000000 


AVFD 

VFO 

1 

00000000000000000000 


CONVOl 

DATA 

2 

5140000001 C 



SA4 


5150777767 

c 


SA5 

3 

66600 



SB6 


63240 



SB2 


6170000012 



SB7 

4 

6140000004 



SB4 


6110000001 



SBl 

5 

54557 


LOOP 

SA5 


43600 



MX6 


63550 



S85 

6 

0605000010 ♦ 



LE 


0654000010 

+ 


GE 

7 

0250000010 * 



JP 

10 

0100000000 X 


ERROR 

RJ 


0700000000 


- 

LT 

11 

0400000017 * 


* 

EQ 

12 

0400000015 ♦ 


♦ 

EQ 

13 

5015000011 


♦ 

SA1 


5025000004 



SA2 

14 

40612 



FX6 

15 

5015000010 


C2 

SAi 


CGNVOl 

CONVOl 

GOTOER. 

/CCONAl/ 

1 

l 

l 

l 

1 

1 

1 

1 

l 

1 

l 

I 

* 

42/OHCQNVOi * 18/0 
0 

NEQ . X4*NEQ 

NTERM-10 . X5=NTERM4 01 
BO .1*0 

X4 • B2*NEQ 

10 .87*10 

4 . B4=4 

1 .01*1 

A5 + B7 . A5=ADD( NT ERMl 1*11 l 

0 .X6=0 

X5+BQ • B5*NTERH ( I +1 1 

B5, 80, ERROR . I F4 NTERM* .LE. 01 GO TO ERROR 
85 9 84* ERROR . IF ( NTERM* .GE . 4 )G0 TO ERROR 
85* ERROR .GO TO ERRQR+NTERM* 

GOTOER. .CALL GOTOER. 

BG, BO, AVFD 

80, 80, Cl .GO TO Cl 

BO, BO, C2 .GO TO C2 

A5 + 9 • A l* AD04 Q3 ( 1 + 1 ) 1 

A 5 +4 . A2= ADD! UDD (I ♦!) I 

Xi*X2 • X6*Q3*UDD 

A5 + B .X1*Q2 
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convoi 



5025000003 

SA2 

16 

60712 

FX7 


30667 

FX6 


26606 

NX6 

17 

5015000007 Cl 

SAL 


5025000002 

SA2 

20 

$5311 

SA3 


55621 

SA6 


60712 

FX7 


60536 

FX5 

21 

30667 

FX6 


26606 

NX6 


30665 

FX6 


26606 

NX6 

22 

66661 

S86 


56660 

SA6 


0762000005 + 

LT 

23 

0600000001 ♦ 

eg 

24 


END 


37500 STORAGE USED 
6600 ASSEMBLY 


COMPASS - VER 2. 08/25/76 07.26. 51. 


A5+3 • X2*U0 

XI *X2 • X7=Q2*UD 

X6+X7 • X6 S X6+Q2*UD 

80 ,X6 

A5 + 7 • X 1= Q l 

A5+2 . X2-U 

Ai-81 .X3=P 

A2-BL . X6- X 

X1*X2 • X7=Q i*U 

X3*X6 .X5=P*X 

X6+X7 • X6-X6*Q1*U 

BOt X6 

X6+X5 • X6 3 =X6+P*X 

BO* X6 

B6+81 .1*1+1 

A6 . X*EXPRESIGN 

86 v&2 f LOOP .IFU.LT.NEQIGO TO LOOP 
CON VOL .RETURN 


59 STATEMENTS 19 SYMBOLS 

0.196 SECOND 31 REFERENCES 
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SUBROUTINE MODLAGIU, Y ,GAIN»RL IMITtOLIM IT ,UPAST t XK 1 


00001 z 


COMMON/ INTCOMH/T , H. iNTtNEQt I SCHEME tOER INTI 2 1281 

000012 


DIMENSION RLIMIT (2) , DLIMITI21 


t** 

COMPUTE ERROR SIGNAL 

000012 


ERR0R=GAIN*(U-Y1 


c*** 

COMPUTE INPUT DERI VIATIVE 

000014 


UD=IU-UPAST)/H 


t 

c** 

COMPUTE XDOT BY APPLYING RATE LIMIT TO ERROR 


c*** 

ALSO COMPUTE PARTIAL OF H WITH RESPECT TO ERROR AND 


c*** 

PARTIAL OF H WITH RESPECT TO TIME 

000016 


I F( ERROR— RL IMIT 41 HI , 1*3 

000021 

1 

XDOT-RL IMI TCI) 

000023 


PHWRE*PHWRT*=G. 

000025 


GO TO 10 

000025 

3 

IF ( ERROR— RLIMIT C 2 1 14*2 *2 

000030 

2 

XP0T-RL1MIT 121 

000032 


PHWRE * PHWRT -0 • 

000034 


GO TO 10 

000034 

4 

XOOT=ERROR 

000036 


PHWRE*l* $ PHWRT=GAIN*UD 

000041 

10 

CONTINUE 


c** 

COMPUTE PARTIAL G WITH RESPECT TO X 

000041 


I F ( XK-DL I M I T ( 1 115,5,6 

000044 

5 

PGWRX=0„ 

000045 


GO TO li 

000046 

6 

I F CXK— OLIMIT 12)17,8*8 

000051 

8 

PGWRX=0. 

000052 


GO TO n 

000053 

7 

PGWRX=1 • 

000055 

11 

CONTINUE 


c** 

COMPUTE A *** 

000055 


A = -GAIN*PHWRE*PGWRX 


C** 

COMPUTE P AND Q 

000060 


IF ( A 1 22,20, 22 

000061 

20 

P = H $ Q=H*H/2« 

000065 


GO TO 23 

000065 

22 

P = < EXP { A*H1-1. 1 / A 

0000 T4 


Q=<P-H)/A 

000076 

23 

CONTINUE 


c** 

INTEGRATE 

000076 


XKPi^XK * P*XDOT + Q*PHWRT 

000104 


Y = XKPi 


c*** 

APPLY DEFLECTION LIMIT TO DETERMINE FINAL OUTPUT 

000110 


1FIY-0LIMITI 1)130,30,31 

000112 

30 

Y * DL IMI T ( 1 ) 

000113 


GO TO 32 

000114 

31 

1 F ( Y-PL IMI T4 2) 133 , 34 * 34 

000117 

34 

Y = 0LIMIT(2l 

000121 


GO TO 32 

000121 

33 

Y = XKPI 

000122 

32 

CONTINUE 

000122 


RETURN 

000123 


END 

SUBROUTINE UNVEC4A,B) 

000005 


DIMENSION A43l,B131 

000005 


AM AG* S ORT 1 A < 1) **2«A < 2 1 4*2 «- A I 3 1 **2 1 

000014 


IFIAMAG.LT. .00001 ) AM AG* 0.09001 

000020 


DO 1 1*1,3 

000022 


BIT 1*AI11/AMAG 

000025 

1 

CONTINUE 

000027 


RETURN 

000030 


END 

FUNCTION 00T1 A, B1 

000005 


DIMENSION Al 31,8131 

000005 


D0T*0* 

000006 


00 l 1*1,3 

000007 


D0T*D0T4AMi*B( 11 

000013 

1 

CONTINUE 

000015 


RETURN 

000016 


END' 
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000006 
000006 
000007 
0000 10 
0000 12 
000013 
000030 
000032 
000033 


SUBROUTINE NULT31 4 A, B*C) 

DIMENSION A(3,3I,B43I,CC3» 

TEMl*B4 11 
TEM2-6421 
TEM3*B(3) 

DO l 1*1,3 

C 4 1 J* A < I • 1 1 *TEM 1«* 1 1 • 2) *T£M2+AI 1 a 31 *TE M3 
1 CONTINUE 
RETURN 
ENO 


000006 

000006 

000006 


000006 


000006 


000006 


000006 


000006 

000006 

000012 

000023 

000025 

000036 

000040 

000041 

000042 

000045 

000046 

000047 

000050 

000051 

000053 

000056 


SUBROUTINE ATMGS31ZZ, ZHAX » ANS WJ 

DIMENSION HBI10),Z8<14>,TMBC24i» ALP424l,GB4i4i,ANSWi81 

DATA 4 DUM*28.9644) , < DUM1=*101325E6 ) * (DUM2«288. 16 ) « 4DUM3-9. 80665) 

DATA 

1 I (HB( I) » 1 = 1 *10) =-5000. 0,0.0, 11000* 0,20000. 0,32000 .0,47000.0, 

152000*0,61000. 0*79000. 0* 88743.01 
DATA 

l C (ZBIll , I S 1 ,141-90000.0, 100000* 0,110000« 0* 120000.0, 150000.0, 16 

10000.0. 170000.0. 190000.0. 230000. 0.300000.0. 400000* 0,500000*0, 60000 

20.0. 700000.0) 

DATA 

1 44TMB41), 1= 1 ,24) =320*6 5, 288 .15, 2 16* 65, 216.65, 228.65 ,270.65 , 

1270.65.252.65. 180.65. 180.65. 180.65.210.65.260.65.360.65, 

2 960. 65.1110. 65. 1210.65. 1350. 65. 1550.65. 1830.65. 2160.65, 
32420.65,2590.65,2700.65) 

DATA 

1 44 ALP4 I), I* 1,241=12. 087778, 11* 526088, 10.02 7120, 8.6079235, 

16.7662077.4. 7086738. 4. 0775458. 2. 9019653.. 37006732E-i, -1.8055744, 

2- 1.8055744,-3. 5040610,-4.9124564,-5.9828218,-7.5886378,-7.9035491, 

3- 8.1833670,-8.6884559,-9.5726883,-10.879634,-12.421644,-13.724116, 

4- 14.879663,-15.942630) 

DATA 

1 I4GB4 I) ,1-1, 147-9. 535, 9*505, 9*476,9*447# 9.360,9*331 ,9.302, 
19.246,9.134,8.942,8.679,8.428,8.187,7.956) 

Z = ZZ 

IF4Z.GT.ZMAX) GO TO 499 

3 G *44 4 4 4-5. 59G5936E-33)*Z*2.972462E-26**Z-i.5l67771E-i9)*Z+7. 25394 
155E— 13 )*Z-3. 0854195E— 64*Z*9. 80665 

I F ( 2-90000.0 ) 4,4,20 

4 H* 4 4 4 4 4 (-9. 501 3649E-35*Z) *6. 0621354E-28) *Z-3. 8667054E-2 1) ♦Z* 
12.4656553E-14)*Z-l.5731262E-7)*Z+l.0)*Z 

IF 4 Z ) 6,5,10 

5 N=2 

GO TO 9 

6 IF 4 Z+5000.0) 499,7,7 

7 N*1 

GO TO 13 
9 AL~0.0 
GO TO 14 

10 DO 11 N=3* 1 0 
IF4H-H64N) ) 12,9,11 

11 CONTINUE 
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000060 


N=9 

000061 


GO TO 9 

000062 

12 

N=N-i 

000064 

13 

AL=i TMBtN+i )-TMB< Nl 1 /< HB (N+ 11 -HB1N J I 

000071 

14 


000075 


IFIALJ 15,16,15 

000076 

15 

ALPP- ALPI NJ — 3«4i631947E-2*ALQG< I AL*(H-HB CN1 J+TMB( NI J /TMB( N) ) /AL 

000 1 i 3 


GO TO 30 

000 1 1 5 

16 

ALPP=ALP<NJ-3.41631947E-2*1H-HB1N) 

000123 


GO TO 30 

000123 

20 

IF ( Z- 700000* Oi 22,21,21 

000126 

21 

M 3 14 . 

000127 


N*24 

000130 


GO TO 26 

000131 

22 

00 23 M-2 ,14 

000133 


IFCZ-ZBIMIJ 24,25,23 

000136 

23 

CONTINUE 

000140 

24 

M 3 M-1 

000142 

25 

N=M+10 

000144 

26 

AL * ( TMBI N+l I-TMB (N ) ) / ( Z8< 1 J -ZB4 M ) 1 

000151 


GG= ( G 4GB 1 M ) 1/2*0 

000154 


TM*TMB(N) +AL *<Z-ZB(M)J 

000161 


IFIAL I 27,28,27 

000162 

27 

ALPP-ALPt N) -3*48367635E-3*GG*AL0G( ( Z-ZBI M) +TMB ( N) /AL T*AL/ THB4 N) I /A 


1L 

000200 


GO TO 30 

000203 

26 

ALPP=ALP( N) ~3» 4 836 7635 E -3 *GG*( Z-ZB ( H ) J /TMB ( N) 

000212 

30 

P*EXPIALPPI 

000214 


RHG*2- 84381 743E-3*P/TM 

000217 


IF i Z“90000* 01 31,31,32 

000224 

31 

WM-28. 9644 

000225 


CS -• 589102444E-“1*T 5 

000231 


T 3 TM**M/DUM 

000234 


X MU= 8 •14785279 E -2 * T ** l . 5/ < T + 1 1 Q . 4 ) 

000244 


GO TO 500 

000244 

32 

CS 791 785926 

000245 


XMU*6.7974E-i 

000247 


Z-Z*l« £—3 

000251 


I FT Z-169. 5) 33,34,34 

000253 

33 

WM 3 i iUiil .i0923927E-13*Z-.iiQ06l85E-iQI*Z+.49584323E-8J*Z-* 13071 
i742E-5)*Z*<.22Q07775E-3>*Z-.2408363l£-l T*Z+.16586041E1)*Z-.65156&05 


2E2 1 ♦Z+1139. Q64 7 

000271 


60 TO 35 

000271 

34 

MM- ( l Mit-.2l764045E-18*Z+. 18921597E- 14J *Z-.43903233E-U1 *2*. 4509 


1 61 84E-8 1*2- *232 85 059E--5 ) *Z*>633 1 1551 E-3) *Z- • 1 1 5 75533 I ♦ Z+36 . 084062 

000305 

35 

T 3 TM*WM/DUM 

000307 


Z=Z*1 • E3 

000311 


GO TO 500 

000312 

499 

T=Q.0 

000313 


TM=0* 0 

000313 


P=0.0 

000314 


RH0=0,Q 

000315 


G 3 0*0 

000316 


WH=0.0 

000317 


CS 791785926 

000321 


XMU* 1*0 

000323 

500 

ANSW(1) 3 P/DUM1 

000325 


ANSttt 2) “T/0UM2 

000327 


ANSWI 3 )=RHO 

000331 


ANSW( 4l=CS 

000332 


ANSfcH 5 ) —G/0UM3 

000334 


ANSWC6)-TM/DUM2 

000336 


ANSWC 7)=HM 

000340 


ANSW(8)-XMU 

000341 


RETURN 

000342 


END 
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